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PREFACE 


This  report  documents  a portion  of  the  work  performed 
at  the  Naval  Surface  Weapons  Center,  White  Oak,  Silver  Spring 
Maryland  on  the  Multiple  Target  Classification  and  Location 
task  for  the  REMBASS  Advanced  Development  under  Agreement 
Number  75-14. 
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Chapter  1 
INTRODUCTION 


Remote  unattended  ground  sensors  are  being  developed 
which  have  the  capability  of  passively  determining  the  bearing 
angle  of  the  targets  they  detect  and  reporting  this  information 
in  real  time  to  a central  location  via  an  RF  link.  For  one 
reason  or  another,  it  is  not  always  known  just  where  the  report- 
ing sensors  are  located  in  an  exact  geographical  sense.  Although 
each  sensor  possesses  a unique  identifier  in  the  message  code 
transmitted,  the  original  emplacement  of  a sensor  field  may  not 
be  done  by  surveying  them  in,  but  rather  by  dropping  them  out  of 
aircraft,  or  using  rocket  or  gun  delivery. 

The  purpose  of  this  task  has  been  to  determine  the  location 
of  such  sensors  after  they  have  been  emplanted.  The  proposed 
method  is  to  move  a target,  whose  location  as  a function  of  time 
is  known,  over  the  sensor  field.  The  sensors  will  each  report 
the  bearing  angle  of  the  target  several  times  as  the  target 
passes  by.  Since  the  target  is  moving,  each  report  by  a sensor 
will  (usually)  be  somewhat  different.  That  is,  the  sensor  will 
report  a series  of  angular  measurements,  which  will  differ  as 
the  target  changes  location.  By  knowing  the  target  location  as 
a function  of  time  back  at  the  sensor  reporting  unit  the  present 
algorithm  will  use  the  series  of  reports  to  calculate  the  sensor 
position.  The  method  used  constructs  radials  from  the  target's 
position  towards  the  sensor.  Each  of  the  many  radials  should 
intersect  at  the  sensor  position,  as  shown  in  Figure  1. 

A weighted  least-squares  algorithm  is  used  to  fit  the  lines 
to  the  point  which  represents  the  sensor  position.  This  theory 
is  relatively  simple,  but  there  are  problems  which  complicate 
the  calculations. 
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Chapter  2 

PROBLEMS  AND  SOLUTIONS 


As  stated  there  are  several  factors  which  complicate  the 
calculation  of  a sensor's  position.  One  of  these  is  the  uncertainty 
of  the  location  and  speed  of  the  "known"  target  used  to  locate 
the  sensor.  A second  problem  occurs  due  to  extraneous  noise  sources 
which  can  distort  the  sensor  reports.  And  a last  source  of  error 
is  the  reference  used  by  the  sensor  to  indicate  the  bearing  or 
direction  of  the  vehicle.  If  the  sensor  thinks  that  North  is 
actually  East,  then  all  of  its  calculations  will  have  a 90  degree 
error  factor  built  into  them. 

Target  Location  Errors 

If  it  is  desired  to  locate  the  sensor  within  25  meters, 
then  it  is  necessary  to  locate  the  known  target  within  25 
meters  (even  more  input  accuracy  is  necessary  when  other  errors 
are  considered).  It  can  be  shown  that  a linear  relation  exists 
between  the  planar  error  in  the  target  location  and  the  resulting 
error  in  the  calculation  of  the  sensor's  position.  The  scale 
factor  is  exactly  one.  For  example,  if  one  thinks  the  target 
is  20  meters  East  of  where  it  actually  is  (throughout  the  track) 
then  the  Sensor  Position  Locator  (SPL)  will  also  be  20  meters 
East  of  where  the  sensor  actually  is.  This  relationship  holds 
for  X and  Y positioning  in  the  horizontal  plane.  Errors  in  the 
altitude  (Z  coordinate)  are  not  as  serious. 

The  problem  here  is  that  a high  speed  jet  used  as  a known 
target  may  be  difficult  to  locate  within  the  desired  accuracy. 

The  problem  of  precisely  locating  a test  target  is  outside  the 
scope  of  this  investigation,  but  the  errors  it  causes  are  not. 

It  is  evident  that  the  available  accuracy  for  sensor  position 
location  is  determined  by  the  current  capabilities  of  target 
position  location  for  cooperating  targets. 

Sensor  Report  Errors 

At  the  time  of  investigation,  the  sensors  themselves  are 
also  under  development.  It  is  not  known  exactly  what  kind  of 
accuracy  these  sensors  will  have,  and  the  bearing  values  reported 
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by  the  sensors  have  to  be  believed,  to  some  extent,  as  the 
truth.  Therefore,  errors  originating  in  the  sensor  will 
propagate  to  the  SPL  algorithm.  It  is  not  the  purpose  of  this 
task  to  reduce  these  inherent  sensor  errors , but  rather  to  reduce 
the  propagation  of  these  errors  to  the  greatest  possible  extent. 
Associated  with  these  "sensor  errors"  are  errors  caused  by  other 
noise  sources  in  the  environment . 

It  is  assumed  that  the  magnitude  of  the  error  does  fluctuate 
and  the  simulation  in  this  work  has  used  gaussian  noise  as  an 
error  model.  It  Is  reasonable  to  try  to  catch  and  use  the  data 
when  it  is  close  to  error-free  and  ignore  the  data  when  it  is 
believed  to  contain  large  errors.  The  problem  is  therefore  to 
find  some  indicator  to  tell  us  of  the  magnitude  of  the  error, 
and  such  indicators  do  exist.  Possibilities  include  signal  to 
noise  ratio,  signal  strength,  and  distance  from  the  sensor  to 
the  target.  The  first  and  last  of  these  indicators  were  used  in 
the  simulation  and  favorable  results  were  obtained. 

The  least- squares  algorithm  will  accept  a weighting  factor 
(W)  based  on  data  quality  and  it  appears  that  full  use  of  it  will 
improve  the  quality  of  the  SPL. 

Because  of  the  multi-pass  SPL  algorithm,  it  Is  possible 
to  estimate  the  radial  distance  from  the  sensor’  to  the  target, 
and  then  use  it  to  construct  a weighting  factor  within  the 
algorithm  itself.  This  too  has  been  done  in  the  simulation  and 
improvements  were  noted. 

Sensor  Rotation  Error 

In  addition  to  assuming  that  the  sensor  will  fall  in  an 
arbitrary  (X,  Y)  position,  it  is  also  assumed  that  the  sensor 
will  have  an  arbitrary  angular  orientation.  When  the  sensor 
reports,  "I  see  a target  at  90  degrees,"  does  that  mean  North, 

East,  South,  or  West? 

It  is  probable  that  each  sensor  will  ultimately  contain  its 
own  compass,  in  which  case,  this  source  of  error  would  be  minimized. 
It  seems  reasonable  that  errors  in  angular  orientation  calculated 
inside  the  sensor  might  be  on  the  order  of  five  degrees , when  one 
considers  that  the  compass  will  be  in  close  proximity  to  metal 
parts  of  the  sensor,  etc.  This  amount  of  angler  error,  called 
angle  bias,  can  produce  very  unsatisfactory  errors  In  the  SPL 
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simulations  (on  the  order  of  hundreds  of  meters).  Therefore, 
it  seems  necessary  to  include  a bias  calculation  within  the 
SPL  algorithm.  Fortunately,  it  is  possible  to  calculate  the 
angle  bias  without  knowing  the  sensor  position,  and  the  latter 
can  then  be  determined  using  this  bias  for  compensation. 

Errors  in  the  SPL  simulation  due  to  all  of  these  sources 
are  discussed  in  more  detail  in  Appendix  A. 
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.Chapter  3 

.MATH  MODEL  FOR  CALCULATION  OF  ROTATION  BIAS 


.This  is  a straightforward  algorithm  that  uses  three 
bearing  reports  (oil,  a2,  a3)  that  all  have  the  same  bias. 

It  is  not  necessary  that  the  reports  be  sequential,  and  in 
fact  if  there  are  many  reports  which  differ  only  slightly  in 
bearing,  then  it  is  advisable  not  to  use  sequential  reports 
because  they  will  probably  be  in  the  same  or  adjacent  bearing 
bin.  The  algorithm  uses  angle  differences  in  which  the  bias 
subtracts  out  and,  using  the  geometry  of  adjacent  triangles, 
calculates  an  internal  angle  which  in  turn  leads  to  the  bias. 
The  algorithm  will  not  work  if  the  angle  differences  are  zero 
which  occurs  if  the  target  has  not  moved. 

Figure  2 shows  the  geometry  necessary  for  the  calculation 
of  the  rotational  bias  of  the  sensor.  If  the  sensor  reports 
the  three  angular  bearings  (ixl.,  a2,  a3)  shown  in  Figure  2, 
then  d12  and  d^  are  the  linear  distances  along  the  target 

track  between  those  reports,  ct^  is  the  direction  of  the  target 

track  with  respect  to  North.  By  applying  the  law  of  sines  to 
Figure  2 one  obtains  equations  1 and  2 and  by  also  applying 
Figure  2, the  law  that  the  sum  of  the  interior  angles  of  a 
triangle  is  180  degrees, one  obtains  equations  3 and  4. 
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Eliminating  dS2  from  equations  1 and  2 yields: 


Sin 
Sin  9 


. d„„  Sin  D 

- 23  sITT2 


(5) 


Using  equations  3 and  5 to  eliminate  D and  then  solving 
for  A one  finds: 


Sin  (01  + 9 2 ) 


arc tan 


12 

*23 


Sin0  2 

'(ST^) 


- cos  (©1  + ©2) 


(6) 


where  0^  = (c^  - a2) 

0 . (a  _ a 
2^2  3) 


Equation  4 can  be  rewritten  to  solve  for  the  rotational 
bias: 

BIAS  = u + aA  - a - A (7) 

Referring  to  Figure  2,  it  is  possible  for  the  rotational 
bias  to  be  in  the  other  direction.  That  is,  for  the  line  N* 
to  be  on  the  other  side  of  N.  If  this  is  the  case,  the  rotational 
bias  from  equation  7 will  turn  out  to  be  negative. 

Least  Squares  Method  for  Bias  Calculation 

Due  to  the  inherent  errors  in  any  system,  the  results 
achieved  by  this  calculation  of  the  rotational  bias  will  be 
in  error  by  some  amount.  If  one  was  to  perform  this  calculation 
several  times  for  different  target  runs  one  would  get  several 
values  for  the  rotational  bias,  called  B. . Assuming  the  errors 
are  gaussian,  a best  value  for  the  rotational  bias  would  be  the 
mean  and  an  indication  of  the  accuracy  of  that  value  would  be 
the  standard  deviation.  If  some  values  are  known  to  be  more 
accurate  than  others,  they  can  be  multiplied  by  some  weighting 
factor,  W. , to  yield  better  results.  Then  the  final  value  for 
the  bias  would  be: 
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n 

2 (W±B1) 
BIAS  = — 


(8) 


n 

1 (w1) 

1=1 


The  standard  deviation  for  this  BIAS  calculation  is: 


J (B2  -BIAS2)1/2 


£ w± 


i=i 


Effects  of  the  Speed  of  Sound 

It  is  easily  observed,  when  listening  to  an  approaching 
high-speed  target,  that  the  target  is  ahead  of  the  incoming 
sound  waves.  This  is  because  the  sound  takes  a finite  At  seconds 
to  travel  from  the  target  to  the  observer.  In  this  At  seconds  the 
target  moves,  and  is  therefore  ahead  of  where  it  was  when  the 
sound  originated. 

The  point  is  to  determine  the  effect  of  this  error  on  the 
calculation  of  the  rotational  bias  and  to  correct  for  it.  In 
two  dimensions  this  error  can  be  deterministically  calculated 
independent  of  radial  distance  and  therefore  can  be  calculated 
without  knowing  the  sensor’s  location. 
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Correction  Algorithm.  Let  At  be  the  time  elapsed  between 
the  time  when  the  sound  originated  at  the  target  (t^)  and  the 

time  when  the  sound  is  received  at  the  sensor  (t~).  Figure  3 
depicts  this  case  where  C is  the  speed  of  sound,  V is  the  velocity 
of  the  target,  C (At)  is  the  distance  from  the  sensor  to  the 
target  at  time  t. , V(At)  is  the  distance  the  target  will  travel  in 

the  time  At,  a.  is  the  target  course, 6 is  the  angular  error  due  to 
the  speed  of  sound,  and  at^  is  the  report  vector  referenced  to  true 

North  (not  sensor  North).  Applying  the  law  of  signs  (equation  12) 
and  the  sum  of  the  interior  angles  of  a triangle  equals  180  degrees 
(equations  10  and  11)  to  Figure  3 yields: 


(l8o  - atl)  + (180  - 

B)  + 

aA  = 180° 

(10) 

y =>  180°  - 0 - B 

(11) 

C (At ) _ V(At) 

Sin  Y Sin  0 

(12) 

Substituting  from  equation 

11 

into  equation 

12  and 

simplifying  gives  the  error  due  to  the  speed  of  sound,  0, 
to  be: 

6 = arctan  v S1-n  — (13) 

y - COS  0 


And  from  equation  (10)  we  find  B is: 

0 = 180  - atl  = aA 

= 180  degrees  - report  bearing  referenced  to  true 
North  + target  course. 
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Figure  4 gives  the  correction  angles  for  some  values  of 
B and  V/C.  As  an  example,  if  the  target  were  reported  such 
that  B * 60  degrees  and  the  velocity  was  300  mph,  or  V/C  * 0.4; 
then  the  target  would  really  be  23  degrees  ahead  of  the  report 
bearing. 

Adjustments  for  3-D.  The  previous  discussions  were  all  done 
in  a two  dimensional  space,  that  is  for  the  target  track  in  the 
same  plane  as  the  sensor.  To  extend  the  algorithm  to  three 
dimensions  will  require  the  following  simplifying  assumptions; 

(1)  that  the  target  will  travel  in  a horizontal  plane  parallel 
to  the  ground  plane,  (2)  that  the  sensor  will  report  in  the  ground 
plane  as  if  the  target  were  also  in  the  ground  plane,  and  (3)  that 
the  altitude  of  the  sensor,  Z0,  will  be  assumed  to  be  zero.  Thus 
the  altitude  of  the  target,  ZA,  is  just  the  perpendicular  distance 
between  the  two  parallel  planes.  Figure  5 depicts  these  assumptions. 

Correction  Due  to  Speed  of  Sound  in  3-D.  In  2-D  the  correction 
error,  0,  due  to  the  speed  of  sound  is  independent  of  the  horizontal 
distance  from  the  sensor  to  the  target  track.  Unfortunately,  this 
is  not  true  if  there  is  a sizable  altitude  difference  between  the 
target  track  and  the  sensor. 


1 


Since  0 is  needed  to  calculate  the  sensor  location  and  the 
sens or  location  is  needed  to  calculate  the  altitude  correction 
to  0,  an  iterative  algorithm  must  be  used  whereby  the  sensor 
location  is  first  calculated  without  the  altitude  correction 
for  0.  This  sensor  location  is  then  used  to  determine  a more 
accurate  value  for  0,  this  new  value  of  0 is  used  to  generate 
an  improved  sensor  location,  and  so  forth  until  the  desired 
accuracy  is  achieved. 

Figure  6 shows  the  speed  of  sound  correction  for  three 
dimensions  where  ZA  is  the  perpendicular  distance  between  the 
target  plane  and  the  sensor  plane,  RXYT..  is  the  distance  from 
the  sensor  to  the  projection  of  the  target  onto  the  sensor 
plane  at  time  t,,  and  0 is  the  correction  error  due  to  the 
speed  of  sound.  1 Note  that  both  Y and  0 are  in  the  ground  plane. 


The  calculations  for  the  three  dimensional  case  are  very 
similar  to  those  for  the  two  dimensional  case.  In  fact,  equations 
10  and  11  still  hold.  However,  equation  12  now  reads: 


RXYT1 
Sin  Y 


(V)  (At) 
Sin  0 


(15) 


J 
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V/C  OR  RATIO 
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FIG.  4 SAMPLE  BEARING  ERROR  DUE  TO  THE  SPEED  OF  SOUND 
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Observe  that  the  projection  of  the  line  (C)  (At)  onto  the  sensor 
plane  forms  a right  triangle.  This  gives  one  a relationship 
between  equations  12  and  15,  namely: 


(C)  (At)  ^(ZA)2 

+ (RXTTX)2 

(16) 

Let 

Ratio  - (£)  (— r 

v .'l- 

1 

(ZA/RXYT^* 

(17) 

Then  equation  13  for  the  three  dimensional  case  becomes: 


0 ■ arctan 


Sing 


Ratio  - cos  g 


(18) 


Unfortunately,  to  calculate  0,  one  needs  to  know  RXYT.  (equation 
17),  and  RXYT1  is  dependent  upon  the  sensor  location. 

Calculating  RXYT^.  Chapter  4 discusses  the  sensor  position. 
Once  this  is  done  one  can  come  back  and  calculate  RXYT^ 


Figure  7 is  a two  dimensional  view  of  the  ground  plane  of 
the  three  dimensional  speed  of  sound  correction  shown  in  Figure  6. 
8 is  defined  by  equation  14,  0 is  the  correction  error  due  to 
the  speed  of  sound,  and  RXYT^  and  RXYT2  are  the  projections  of 

(C)(At)  and  (dst2)  onto  the  sensor  plane. 


From  the  definition  of  the  sine  of  a right  triangle  it  is 
seen  from  Figure  7 that : 


RXYT1 


V2  * CYo  - V2 

Sin  g 


(19) 


19 
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The  value  (XQ  - Y ) + (YQ  - Y ) Is  simply  the  distance  between 

the  two  points  (XQ,  YQ)  and(Xp,  Yp).  The  point  (XQ,  YQ)  is  the 

sensor  location  which  is  calculated  in  Chapter  4.  The  other  point 

(X  , Y ) is  calculated  as  the  point  on  the  target  track  closest  to 
P P 

the  sensor. 

The  equation  of  the  line  (ATX  + BTY  + CT  = 0)  can  be  found 

from  any  point  (X™  , Y-,  ) on  that  line  and  from  the  slope  (a.) 

if 

of  that  line.  Prom  standard  algebraic  formulas: 


At  = cos  (oA) 


Bt  = sin  (aA) 


CT  * ATXTj_  " 


The  co-ordinates  of  the  point  (X  , Y ) on  the  line 
AtX  + BtY  + CT  = 0 that  is  closest  topthep  point  (XQ,  YQ)  is 

given  by: 

-(AC  + B X ) 

X = (23) 

P 2 ? 

(at  + BT  } 


at(AtYq  ~ BTXq)  ~ btct 


(Am^  + B 2) 


Now  RXYT1  (equation  19)  can  be  calculated  and  substituted  into 
equations  17  and  18. 


•t-  \t  **.*&!*■< 
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CALCULATION  OF  SENSOR  POSITION 


At  this  point  It  is  assumed  that  the  reported  bearing  has 
been  corrected  and  that  it  points  from  the  sensor  to  the  target 
at  time  The  method  of  approach  is  to  calculate  the  parameters 

of  a line,  L^  = aix  + b^y  + c^,  passing  through  the  target  and 

along  the  reported  bearing  ray.  This  is  done  for  every  report. 
Therefore,  many  lines  will  be  calculated,  all  of  which  should 
intersect  at  the  sensor's  position.  Because  of  the  Inaccuracies 

in  the  bearing  report  and  in  the  target's  position  it  is  not 
expected  that  every  line  will  intersect  exactly  at  the  sensor's 
position.  Figure  8 shows  a typical  case. 

The  idea  is  to  find  a point  (XQ,  YQ)  which  best  fits  the 

intersection  of  all  the  lines.  A weighted  least-squares  algorithm 
is  used,  and  the  distance  function  is  the  ratio  of  the  perpendicular 
distance,  d,  from  the  point  (XQ,  YQ)  to  each  line  over  the  radial 

distance,  rxy,  (where  rxy  is  equivalent  to  RXYT£  in  Figure  6)  from 

the  target  to  the  sensor.  This  ratio  is  the  arc  sine  of  theta, 0^, 
as  shown  in  Figure  9 for  one  bearing  report.  For  small  0, 


Math  Model  for  SPL 

The  weighted  least- squares  algorithm  to  be  used  requires 
minimizing  the  equation  below  where  is  a weighting  function: 


2«i(ei>2 


LOCATION 

(XO,YO) 
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The  distance  from  the  sensor  location,  point  (Xg,  Yg),  to  the 
line  Li  is  given  by: 


d . aixo  = biY0  + Ci 


. 2 . . 2 

ai  + bi 


The  length  of  the  line  rxyi  is  given  below  where  (XQ,  Yg) 
is  the  sensor  location  and  (XT1,  Y^ ) is  the  1th  target  location 


rxy±  = ^Xg  - XT1)2  + (Yg  - YT1)2  (28) 

Substituting  equations  25  and  27  into  equation  26,  one  gets: 


„ _^wi(aixo : Vo  i v2 

i=l  (ai2  + b^2 ) (rxy±)2 


To  minimize  equation  29  one  needs  to  take  the  partials  with 
respect  to  XQ  and  YQ.  To  simplify  these  calculations  let  XQ  and 

Yg  in  equation  28  be  the  sensor  position  from  a previous  calculation 

(Xg,  Yg).  Then  rxy^  is  not  a function  of  XQ  and  YQ  and  can  be 

treated  as  a constant.  The  above  simplifying  assumption  results  in 
acceptable  errors.  Without  this  assumption  the  model  cannot  be 
brought  into  closed  form.  A more  complex  derivation  has  been  worked 
out  but  not  implemented  here.  It  was  abandoned  because  of  the  fast 
growth  of  complexity  with  little  promise  of  any  accuracy  to  be  gained. 

Taking  the  partials  of  equation  29  with  respect  to  XQ  and  YQ 

and  setting  them  equal  to  zero  gives  the  following  formulas  for 
calculation  of  XQ  and  YQ: 


-*  r • i.  ..  - 
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Calculation  of 

In  order  to  evaluate  equations  30  and  31  one  needs  to 
calculate  the  parameters  A^,  , and  C.^  that  form  the  line 

AiX  +BiY+Ci“°*  This  line  passes  through  the  target  position 

(XT^,  YT^)  and  has  a corrected  report  bearing  of  d + c as  shown 

in  Figure  10.  dtc  is  just  at.  - 0.  Since  the  slope  and  one 
point  on  a line  determine  its  equation,  we  find  that: 


Ai 

= cos  (dfc) 

(32) 

Bi 

= Sin  (d+c) 

(33) 

ci 

- A.1(XT1)  - Bi(YT1) 

(34) 

Substituting  these  values  and  rxy,  (equation  28)  into  equations 
30  and  31  one  can  solve  iteratively  for  the  sensor  position 
(XQ,  Yq).  An  iterative  solution  is  necessary  since  rxy^  is  cal- 
culated using  the  values  of  (XQ,  YQ)  obtained  from  the  previous 
iteration. 
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Chapter  5 

APPLICATION  OP  SPL  ALGORITHM 

] 

To  facilitate  the  calculations  involved  with  the  implemen- 
tation of  this  algorithm,  a computer  program  was  written.  This 
program  and  the  flow  charts  associated  with  it  are  shown  in  Appendix 
B. 

» 

Then  using  this  computer  program,  the  algorithm  was  tested  with 
two  trial  runs. 

Run  it  1 

The  first,  called  Run  #1,  consists  of  a truck  traveling  at 
20  miles  per  hour  along  the  target  track  shown  in  Figure  11.  The 
sensor  had  a rotational  bias  of  -25  degrees  and  was  located  100 
meters  from  the  target  track.  The  sensor  indicated  25  detections 
at  the  times  and  bearings  shown  below. 


Run  #1  Sensor  Reports 


Time 

Bearing 

W 

34.00 

116.00 

1.00 

35.00 

119.00 

1.00 

38.00 

122.00 

1.00 

39.00 

127.00 

1.00 

40.00 

136.00 

1.00 

41.00 

144.00 

1.00 

45.00 

147.00 

1.00 

46.00 

153-00 

1.00 

47.00 

158.00 

1.00 

48.00 

164.00 

1.00 

49.00 

172.00 

1.00 

50.00 

178.00 

1.00 

51.00 

186.00 

1.00 

52.00 

192.00 

1.00 

53.00 

198.00 

1.00 

54.00 

203.00 

1.00 

55.00 

209.00 

1.00 

57.00 

212.00 

1.00 

58.00 

217.00 

1.00 

59.00 

223.00 

1.00 

63.00 

226.00 

1.00 

65.00 

229.00 

1.00 

66.00 

231.00 

1.00 

67.00 

234.00 

1.00 

69.00 

237.00 

1.00 
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The  weighting  factor  used  in  the  calculations  was  1.00  for  all 
points.  When  the  test  vehicle  passed  certain  locations  along  the 
target  track,  called  stakes,  the  time  was  noted.  These  times  and 
the  stake  locations  are  also  included  in  Figure  11. 

The  sensor  position  was  calculated  under  three  different 
conditions.  For  the  first  case,  the  rotational  bias  of  the 
sensor  was  calculated  and  this  value  was  used  in  calculating  the 
location  of  the  sensor.  In  the  other  two  cases,  a value  for  the 
rotational  bias  of  the  sensor  was  put  into  the  program  and  this 
value  was  used  to  calculate  the  sensor  location.  The  results 
of  these  three  calculations  are  shown  below  where  (X0,  Y0)  is  the 
sensor  location.  Radial  error  ■/ r 5-  and  ALROT  is  the 

(xor  + (Y0)  , 

sensor  angular  rotation  bias  (either  calculated  or  externally  set 
equal  to  some  value. 


ROTATIONAL 

XO 

BIAS  CALCULATED 
Y0 

ALROT 

REAL 

0 

100.00000 

0 

CALCULATED 

-38.21974 

86.88408 

-5.29993 

DIFFERENCE 

38.21974 

13.11592 

5.29993 

RADIAL  ERROR 

40.40762 

ROTATIONAL  BIAS  SET  = 0 DEGREES 


XO 

Y0 

ALROT 

REAL 

0 

100.00000 

0 

CALCULATED 

-50.52054 

88.81540 

0 

DIFFERENCE 

50.52054 

11.18460 

0 

RADIAL  ERROR 

51.74380 
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ROTATIONAL 

BIAS  SET  -25 

DEGREES 

XO 

Y0 

ALROT 

REAL 

0 

100.00000 

-25.00000 

CALCULATED 

-3.74224 

103.15131 

-25.00000 

DIFFERENCE 

3.74224 

-3.15131 

0 

RADIAL  ERROR 

4.89235 

The  Radial  Error  is  lowest  for  the  case  where  the  rotational 
bias  was  set  at  -25  degrees,  which  indicates  that  the  best 
results  were  achieved  in  this  case.  This  is  true  because  the 
actual  rotational  bias  of  the  sensor  was  -25  degrees. 

Figures  12  and  13  graphically  depict  the  two  cases  where 
the  rotational  bias  was  externally  set  to  either  0 or  -25  degrees. 
In  these  figures  lines  were  drawn  from  the  vehicle  location 
(whenever  the  sensor  made  a report)  towards  the  sensor  along 
a corrected  bearing.  This  corrected  bearing  was  just  the  bearing 
reported  by  the  sensor  plus  l80°  minus  the  rotational  bias  of  the 
sensor. 

Run  #2 


The  second  run  was  very  similar  to  the  first.  This  time  a 
truck  was  again  driven  by  the  sensor  at  a CPA  of  100  meters,  and 
with  a velocity  of  9 meters/second.  However,  this  time  the  sensor 
had  a rotation  bias  of  9 degrees,  and  the  sensor  was  placed  on  the 
other  side  of  the  target  track.  Figure  14  shows  the  target  track 
and  the  times  that  the  vehicle  passed  the  different  stake  locations. 
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SIMULATED  RUN# 2;  TARGET  TRACK 
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The  sensor  indicated  detections  at  the  times  and  bearings 
shown  below. 


TIME 

BEARING 

W 

23.00 

51.00 

1.00 

25.00 

46.00 

1.00 

28.00 

43.00 

1.00 

29.00 

37.00 

1.00 

30.00 

34.00 

1.00 

31.00 

26.00 

1.00 

32.00 

23.00 

1.00 

Two  SPL  calculations  were  made;  one  with  the  rotational  bias 


calculated  and  the 
are  shown  below: 

other  with  it  set 

at  0 degrees. 

The  results 

BIAS  CALCULATED 

XO 

Y0 

ALROT 

REAL 

0 

-100.00000 

0 

CALCULATED 

1.47177 

-67.59963  -23 

.99265 

DIFFERENCE 

-1.47177 

-32.40037  23 

.99265 

RADIAL  ERROR 

32.43378 

BIAS  SET  = 

0 DEGREES 

XO 

Y0 

ALROT 

REAL 

0 

-100.00000 

0 

CALCULATED 

-3.67670 

-86.62461 

0 

DIFFERENCE 

3.67670 

-11.37539 

0 

RADIAL  ERROR 

11.95482 
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The  reason  the  SPL  calculation  with  the  bias  calculated 
was  so  poor  was  because  the  reports  were  few  and  very  close 
together.  A good  bias  calculation  occurs  when  there  are  many 
reports  and  when  the  reports  are  widely  spaced.  The  error  occurs 
because  the  angle  difference  with  close  reports  is  often  Just  a 
bearing  bin  shift  and  is  not  truly  representative  of  bearing 
movement . 

A graphical  sensor  location  is  shown  in  Figure  15  for  the 
SPL  calculation  where  the  bias  was  set  equal  to  zero.  This  was 
accomplished  by  drawing  a line  along  the  corrected  report  bearing 
from  the  vehicle  location  for  each  sensor  report.  The  intersection 
of  these  lines  locates  the  sensor  position  as  is  done  arithmetically 
in  the  computer  using  this  program. 

The  sensor  location  accuracy  of  these  runs  could  be  improved 
by  applying  appropriate  weighting  functions  to  the  data,  adding 
a compass  to  the  sensor,  or  by  running  several  target  vehicles 
past  the  sensor. 

Conclusions 


For  a sensor  which  reports  a target  bearing  angle  in 
addition  to  a detection,  this  algorithm  can  determine  the  location 
of  that  sensor  after  deployment.  This  report  discusses  the  method 
used,  presents  a computer  program  capable  of  accomplishing  the  task, 
and  does  this  analysis  for  two  sensors  of  "unknown"  location. 
Although  better  results  could  be  obtained  by  applying  weighting 
functions  to  the  data  or  adding  a compass  to  the  sensor,  this 
method  located  two  sensors  within  40  ft  of  their  actual  location. 
This  location  algorithm  increases  the  flexibility  of  sensor  place- 
ment for  sensors  which  report  target  bearing. 
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APPENDIX  A 
ERROR  ANALYSIS 

There  are  many  factors  which  contribute  to  errors  in 
accurately  locating  a sensor.  These  include: 

1.  Calculation  of  the  rotational  bias  of  the  sensor,  BIAS 

2.  Gaussian  Noise,  XK 

3.  Target  course  error,  AALA 

4.  Target  X position  error,  AX 

5.  Target  Y position  error,  AY 

6.  Target  Z position  error,  AZ 

7.  Target  Velocity  error,  AV 

8.  Temperature  error,  A temp 

9.  The  bearing  resolution  of  the  sensor,  BINS 

Errors  due  to  these  sources  were  computed  for  58  simulated  runs 
under  four  conditions.  These  conditions  were: 

1.  Rotational  bias  calculated,  one  target  vehicle 

2.  Rotational  bias  set,  one  target  vehicle 

3-  Rotational  bias  calculated,  two  target  vehicles 

4.  Rotational  bias  set,  two  target  vehicles 

The  results  of  these  runs  are  shown  in  Table  1.  Unless  specified 
the  input  parameters  were: 


BIAS 

s 

0 

degrees 

V = 0 meters/sec 

AXK 

= 

0 

temp  = 0 degrees 

AALA 

= 

0 

degrees 

number  of  Bins  = 100,000 
(runs  1-47) 

AX 

— 

0 

meters 

AY 

= 

0 

meters 

number  of  Bins  = 256 
(runs  53-58) 

Az 

— 

0 

meters 
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These  sensor  location  errors  were  calculated  for  sensor  positions 
100,  500,  and  1000  meters  from  the  target  track.  The  vehicle  was 
traveling  at  50  m/s  at  an  altitude  of  200  m.  The  range  of  the 
target  track  was  3000  meters.  In  Table  1,  DR^qq,  DR^qq,  and 

DRiqqo  refer  to  the  distance  of  the  sensor  from  the  test  track. 

All  sensor  location  errors  are  in  meters  displayed  from  their 
actual  location. 

Bias  Errors 


In  Table  1 the  bias  errors  only  affected  the  cases  where  the 
bias  was  set.  In  those  cases,  the  bias  was  set  equal  to  that 
error  amount  and  the  sensor  position  error  was  calculated.  In  the 
cases  where  the  bias  was  calculated,  it  was  calculated  correctly 
as  all  other  parameters  were  "error  free."  Using  this  correctly 
calculated  bias  the  sensor  position  was  accurate.  Figure  16  shows 
the  effect  of  bias  errors  on  the  SPL  algorithm.  The  results  are 
about  the  same  for  one  or  two  targets,  but  do  depend  on  the  distance 
of  the  sensor  from  the  target  track. 

Gaussian  Noise 


The  signal  received  by  the  sensor  from  some  target  source 
contains  noise.  This  noise  affects  the  bearing  angle  reported 
by  the  sensor. 

All  noise  is  assumed  to  be  Gaussian  added  to  the  real  report 
bearing.  This  noise  consists  of  an  average  value  (Mean)  and  a 
standard  deviation  (Sigma).  The  mean  is  just  the  bias.  Sigma 
is  a function  of  the  signal  to  noise  ratio.  The  higher  the  ratio 
the  lower  the  error.  The  following  relationship  has  been  observed: 


Sigma  = 


K, 


S/N 


(35) 


S/N  is  inversely  proportional  to  the  radial  distance  from 
the  sensor  to  the  target.  Equation  36  depicts  this  relationship, 
where  S/Ncpa  is  the  signal  to  noise  ratio  at  the  closest  point  of 

approach  (cpa) . 


A-2 
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AFFECTS  OF  BIAS  ON  SPL  ERRORS 


BIAS  IN  DEGREES 

A- 4 FIGURE  16 
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K0  + S/N 

S/N  * f (D)  = — 2 . . CP—  (36) 

V 

D + 1 

Combining  equations  35  and  36  gives: 

/ 

Sigma  = K D + 1 (37) 


For  the  error  analysis  values  of  .0001,  .001,  .005,  and 
.01  were  used  for  K.  Figure  17  plots  the  radial  error  (meters) 
of  the  sensor  as  a function  of  K.  From  Figure  17  it  is  noted  that 
repeating  the  calculations  for  a second  target  greatly  reduces  the 
error  from  this  source. 

Target  Course  Error 

This  error  comes  about  when  the  test  vehicle  is  traveling 
in  a direction  slightly  different  than  it  is  thought  to  be  traveling. 
Figure  18  plots  these  errors  as  a function  of  course  error  (in 
degrees) . 

AX,  AY  Errors 


This  type  of  error  occurs  when  the  target  vehicle  is  at  a 
point  different  than  it  is  thought  to  be.  Equation  38  gives  the 
radial  error  of  the  sensor  as  a function  of  the  AX,  AY  displace- 
ment . 


radial  error 


= ’'(AX)2  + (AY) 2 


(38) 


The  amount  of  this  error  is  independent  of  whether  the  rotational 
bias  is  calculated  or  set  equal  to  some  value  in  the  SPL  algorithm, 
and  it  is  independent  of  the  number  of  test  vehicles  provided  the 
AX,  AY  displacement  of  each  vehicle  is  the  same. 

AZ  Errors 


This  error  results  from  inaccurate  estimates  of  the  differences 
in  altitude  between  the  target  track  plane  and  the  sensor  plane. 

It  is  independent  of  the  number  of  targets  used  to  sight  in  the 
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AFFECTS  OF  K (GAUSSIAN  NOISE)  ON 

SPL  ERRORS 
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sensor  and  is  not  a function  of  whether  the  rotational  bias  of 
the  sensor  was  calculated  or  set  to  the  correct  value.  As  can 
be  seen  in  Figure  19  it  is  very  much  a function  of  the  distance 
of  the  sensor  from  the  target  track. 

Target  Velocity  Errors 

Radial  sensor  location  errors  due  to  miscalculation  of 
the  target  velocity  are  independent  of  the  distance  of  the 
sensor  from  the  test  track  and  independent  whether  or  not  the 
rotational  bias  of  the  sensor  is  calculated.  Figure  20  is  a 
graph  of  the  radial  sensor  location  error  as  a function  of  the 
target  velocity  error. 

Temperature  Errors 

The  sensor  location  error  due  to  temperature  differences 
is  shown  in  Figure  21.  It  is  not  a function  of  the  number  of 
target  vehicles. 

Errors  Due  to  Lack  of  Bearing  Bins 

The  number  of  bearing  bins  refers  to  the  number  of  sections 
of  a circle  (360  degrees)  into  which  a sensor  can  locate  a target. 

If  the  sensor  can  only  indicate  in  which  quadrant  the  target  is, 
then  the  number  of  bearing  bins  equals  four.  Obviously,  the  more 
bins  into  which  the  sensor  can  place  the  target,  the  more  accurately 
it  can  locate  that  target.  It  also  follows  that  with  more  bearing 
bins,  the  sensor  can  be  more  accurately  located.  Figure  22  depicts 
the  affect  of  the  number  of  bearing  bins  on  the  radial  sensor 
location  error. 
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APPENDIX  B 

FORTRAN  PROGRAMS  AND  FLOW  CHARTS 


Since  there  are  many  calculations  involved  in  locating  a 
sensor  position,  it  is  best  done  using  a computer.  Appendix  B 
is  a listing  of  the  flow  charts  and  the  computer  program  used 
to  accomplish  this.  The  computer  program  is  called  Simulate, 
and  it  calls  nine  subroutines  called  Input,  Senchk,  Output,  SPL, 
Enter,  Shift,  TXY,  Normal  and  Uniform. 

Program  Simulate  is  the  program  which  locates  the  sensor 
position.  It  accomplishes  this  by  calling  four  subroutines; 

INPUT,  SENCHK,  SPL,  and  OUTPUT. 

Subroutine  INPUT  loads  the  initial  parameters  into  the 
program. 

Subroutine  SENCHK  picks  which  sensor  reports  should  be 
used  in  the  calculation.  For  those  reports  it  provides  the  time 
of  report,  report  bearing,  and  a weighting  function  to  the  main 
program. 

Subroutine  SPL  calculates  the  sensor  location  and  the 
rotational  bias  from  the  data  provided  to  it  from  the  main 
program. 

Subroutine  OUTPUT  prints  out  the  results  of  the  calculations. 

There  are  five  other  subroutines  which  are  used  in  this 
program.  Subroutines  Normal  and  Uniform  together  provide  a random 
number  uniformly  distributed  between  0 and  1 to  Subroutine  SENCHK. 
Subroutines  Enter,  Shift,  and  TXY  simply  perform  minor  arithmetic 
calculations  needed  in  the  SPL  Subroutine. 

The  flow  charts,  Figures  23-30,  and  computer  printout  for 
these  programs.  Figure  31 > follow. 
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. :t_  F Ok  Than  < 1 , 0) 


C00C0 

c 
c 
c 
c 
c 
c 
c 
c 
c 
c 
c 
c 
c 
c 
c 
c 
c 
c 
c 
c 
c 
c 
c 
c 
c 
c 
c 
c 
c 
c 
c 
c 
c 
c 
c 
c 
c 
c 
c 
c 
c 

00001  COMMON  /TRGT //  ALA (3> . *A (3) , YA (3) ,ZA (3) , 

00001  1 TA ( 3) , va ( 3) . At (3) ,BT (3) .CT (3) * Tfc"P . CS . NTRG 

00003  COMMON  /RT-JGT//  RALA  ( 3 ) . RX  H ( 3 ) . « r A ( J)  . RZA  ( 3)  « 

00002  1 PT  A (3)  ,pv  A (3)  ,*T£Mp, pCs 

00003  COMMON  /St'//  NSEN.XO (3) .Y0 (3> .ALRO' O) » IFLAB. JFlAG 

QOftO*  COMMON  /RSFN//  RXO (3) » RY  3 (3) » RALPOT 13) 

00005  COMMON  /R£°//  TSAVE (3.3.50)  . A3A vF ( 3 » 3 » 50 > . wS  A V£  ( 3 , 3 . SO ) . 

00005  1 NREP (3.3) « T NCSAyE (3.3) 

0 0 0 C 6 COMMON  /state//  TLP  t 3 > • Al.P  ( 3>  » vFl AG • 3 ) . F HEC  < 2 ) • 

0 0 0 06  1 u I NS  « AmE AN . XK.SNCPA.RAHGE.DEL  U.IN.UM.NHUN.NRUNA  .SAVE ( {ft , 100) 

OOOOT  common  /CONST//  PI.PT32.PI2 

00008  COMMON  /OPTIONS//  KFLAG.H.NPASS 

FIG.  31  COMPUTER  PROGRAM 
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PROGRAM  SIMULATE 


JONATHAN  V AL V ANO  03/1&/TS 

THESE  PROGRAMS  SIMULATE  a SENSOR  ElELO  FOR  ThE 
DEVELOPMENT  OF  A SENSOR  POSITION  LOCATOR  (SPL). 

ACOUSTIC  SENSORS  ARE  DEPLOYED  IN  ThE  FItLO  WITHOUT 
ThE  NNOwLEnGE  OF  THEIR  EXACT  LOCATION,  THIS  C«N  BE  PONE 
RY  AlH  DRUP  OR  GUN  DELIVERY,  THE  PURPOSE  OF  THESE 
ROUTINES  IS  TO  LOCATE  THE  SENSORS  ONCE  THEY  ARt  IN  ThE 
FIELD.  The;  FOLLOWING  METHOD  IS  USED.,.. 

1.  A TARGET.  WHOSF  POSITION  AS  A FUNCTION  OF  TI“F 
IS  KNGwN . IS  RUN  OVER  THE  SENSOR  FIELD. 

2.  ThF  PECIEVINg  UNIT  LISTENS  AN0  HECORuS  ThE  SFDUENCE 
OF  REPORTS  BY  THE  SENSOR  OF  THE  TARGET, 

3.  ThF  ARRAYS  OF  REPORTS  ULUS  Tm£  TARGET  LOCATIONS 
ARE  FED  AS  Inputs  TO  The  SPL  ALGORITHM. 

*►.  SPL  CALCULATES  THE  SENSOR  LOCATION  (ANO  BUS  ANGLE) 

THE  FOLLOWING  OPTIONS  ARE  AVAILABLE  TO  SPL... 

KfLAGwO  IF  The  BUS  IS  TO  Bt  CALCULATED. 

KFlAGxl  IF  THE  RUS  IS  REPORTED  ( InPuTED  TO  SPl.> 

m is  the  increment  factor  (see  spd 

NRaSS  is  The  nijmmer  OF  PASSES  SPl  MAKES  OVER  REPORTS 

the  following  options  are  available  to  the  simulation... 
NSFN  the  number  of  sensors 

nthg  the  number  of  targets 

RANGE  the  range  of  the  SENSORS 

BINS  THE  NUMBER  OF  bearing  BINS  CF  Tm£  SENSOR 

FREQM)  The  cycle  time  when  The  bearing  Changes 

FRECt?)  THE  CTClF  time  ;vhEN  ThF  bearing  Is  the  same 

delta  the  time  increment  in  the  simulation 
xhea.n, xk.sncpa  are  for  Gaussian  error 

MEANS  A HE AN 

SIGMasak/SORT (SmCPa/(0xY£*1) ) 


SSL 


. C F L ^ T H A iN  ( 1 • v ) 


P*JOG»AM  S I M,IL  ATE 


J 


\ 


00009 


oonlo 
0001  1 
00012 
OOOU 


00015 

00016 
000  17 
00016 

00019 

00020 
00021 
00022 

00023 

00024 


C 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

1 

1 


OC0COoWV00oe<Mlt()vO**0<MMMMM>lHK>**t**»-<'5O0V00V*«M>0<H»O'>0**«*u<>o0O*O# 
* • 
• FIRST  CALL  INPUT  TO  SET  UP  THE  SIMULATION  • 


CALL  iNPU T 


« 

4» 

0 


Then  HtftD  the  OPTIONS  FOP  This  SET  OF  RONS 

This  is  THF  START  OF  a set  of  runs  «ITH  SEPEWAft  OPTIONS. 


01  READ  103*  ><FLAG,M.NPASS.NRUNX 

03  format  (4110) 

IF  (NR ASS  ,E<S.  0)  RETURN 
NRUN* 1 


SAVE  CONTAINS  ThE  SIMULATION  OPTIONS  FOR  Each  Run  OF  SET 

all  angle  inputs  and  outputs  are  In  degrees  and 

ALL  IMFRNAl  ANGLES  APF  in  RAOIAnS. 

ala  is  THF  INPuTED  TARGET  COURSE. 

RALA  IS  THF.  REAl.  TARGET  COURSE. • 

V A IS  THE  INPUTED  TARGET  VELOCITY. 

RVA  IS  THE  REAL  TtRGET  VELOCITY. 

* AT  TIME  Ta  (SECONDS  Thf;  TARGET  IS  Al  <XA*Ya.?A>  INPUTED. 

* AT  TIKE  RTA  (SEC)  THE  TARGET  IS  AT  (RXA.RYA.RZA)  REAL. 

» 


llo 


C 

c 

c 

c 

c 


Bl ASSSAVE ( ) . NRUN) *PI/1 R0.0 

XK  = S A V E ( ? » f R JN ) 

SNCPa*SAVE ( 3 . nRun ) 

00  155  NTs) . NT Rp 

ALA (NT) sR ALA (NT) ♦ SA VE ( 4 . NRUN ) *P 1 / 1 90 . 0 
XA  (NT  ) sPXA  (NT)  *SAV£  (P.NpijN) 
YA(NT)sRYA(NT)*SAVE  (6.NRIJN) 

ZA (NT ) =RZA (NT) *SAVE (7 .NRUN) 

VA  (NT ) sPvA (NT) *SAVE (B.NRuN) 

TA  (NT ) »RTA (NT) 
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.^A3i4| 


4 


■ _t  F UK  THAN  M .0) 


PROGRAM  SIMULATE 


00025 

00026 
00027 
0002B 


AT.dT.CT  form  The  LINE  AT*X*BT*Y*CT=0  OF  THE  TARGET  track. 


AT  (NT)»COS(AUA(MT) ) 

BT (NT)b-sIN(ALA(NT) ) 

CT (NT)*- ( AT (NT) *XA (NT) .BT (NT) *YA (NT)  1 
CONTINUE 


CS  lb  THE  IMPUTED  SPEED  OF  SUUND  IN  METERS/SECOnD. 
PCS  lb  THE  REAL  SPEFD  OF  SOUNO  IN  mETERS/SECOnD. 

TEMP  is  T“E  IMPUTED  TEMPERATURE  In  CENTIGRADE. 
RTEMP  IS  Th£  REAL  TEMPERATURt  IN  CENTIGRADE. 


00029 

00030 

00031 

00032 


ttMP»RTFMP»SAVE (9.NRUN) 
CS*331 .36 *0.6096* TEMP 
BlNS»SAVE ( 10.NRUN) 

00  160  I a 1 .3 


(*0.Y0)  IS  THE  CALCULATED  SENSOR  POSITION. 

(RAO.HYO)  TS  The  REAL  SENSOR  POSITION. 

ALROT  Is  EITHER  The  CALCULATED  oh  IMPUTED  sensor 

angle  POTATION  Et«s.  DEPENDING  ON  OPTION-  KFLAG. 

RALROT  is  the  PEAL  SENSOR  ANGLE  ROTATION  BIAS. 

MFLAGaO  *»hcN  The  TARGET  IS  WITHIN  RANGE  OF  ThaT  SEmSOP. 
MFLAGal  when  The  TARGET  IS  OUTSIDE  The  RANGE  OF  THAT  SENSOR 


00033 

0003a 

00035 

00036 

00037 
00039 
000*1 
000*2 
000*3 


X0(I)*0.0 

rodjao.o 

AlROT (I)sO.O 
mFLAG(I)bO 

IF  (KFlag  , Eu.  0)  xmeamsRIAS 

if  ikflag  ,eu.  l)  alrot < n *ralrot u ) *h! as 

00  lbO  js 1.3 
INCSmvE<I.J)sU 
NHEP  ( I . J)  s') 


“.Ol  FORTRAN  (1,0) 


PROGRAM  SIMULATE 


0 00** 

DO  125  NT* 1 , NTRG 

000*5 

T 1 Mt  = 0 , 0 

0 00*6 

C 

DO  111  Jsi.3 

C * 

C * 

TlR  15  THE  TIME  OF  THE  LAST  REPORT. 

C * 

c * 

AL«  15  THE  ANGLE  OF  THE 

LAST  REPOHT. 

000*7 

c 

TLR(I)s-50.0 

0 0 0*8 

alR  < 1 >«0.0 

000*9 

111 

CONTINUE 

00050 

115 

C 

C * 
C • 

DO  120  NS=1 ,NSEN 

><tc 

C • 

SEN'LHK  WILL  CHECK  TO  SEE 

if  the  sensoh  should  report. 

c • 

IF  50  IT  DETERMINES  The 

TIME  OF  THE  REPORT  AND 

PUTS  IT 

C A 

IN  T5AVE.  IT  DETERMINES 

THE  HEARING  AND  PUTS  II 

IN  ASAVE. 

c « 

c • 

IF  The  SENSOR  REPORTS  A 

WEIGHTING  FACTOR  IT  IS 

IN  WSAVE. 

c 

c 


00051 

120 

CALL  SENCHK(NS»TIME,NT) 

00052 

TIME=TIME*DELTA 

00053 

DO  121  NS= 1 * NSEN 

0005* 

IF  (ME LAG (NS ) • EO . 0)  GO  TO  115 

00056 

121 

COM  INuE 

00057 

125 

COM  INUE 

C 

c • 

c * 

c * 

NOw  The  ARRAYS  (TSAVE. ASAVE.wSAVE)  are  FULL. 

c • 

c • 

c 

00058 

c 

do  no  nssi.nsen 

c *«►* 

c * 

c * 

CALL  THE  SENSOR  POSITION  LOCATOR  (SPL). 

c * 

c ••• 

c 

0C059  CAUL  5PLINS) 

00060  130  CONTINUE 

C 

c 

c 

c 

c 

c 
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.r  L FORTRAN  (1.0) 


PROGRAM  -s  1 J(_ A T E 


CALL  OUTPUT  TO  PRINT  RESULTS. 


00061  CALL  OUTPUT 

00062  nhun»nhun*i 

00063  NPUNX»nPUN*«1 

0006*  IF  ( NRUN  .ST.  NUM)  GO  TO  101 

00066  GO  TO  110 

00067  END 

NOL  FORTRAN  DIAGNOSTIC  RESULTS  - FOR  SIMULATE 


NO  ERRORS 


Tt  t 


;0|_  FORTRAN  (1.0) 


PRUoRAt*  ST'HII.ATE 


DATA  VARIABLES 


ALA 

00001 

00019 

00025 

00026 

ALR 

00006 

OOOA8 

ALROT 

0 00  0 3 

00035 

00040 

ASAVE 

00O05 

AT 

00001 

00025 

00027 

BINS 

00006 

00031 

BT 

ooool 

0 0026 

00027 

cs 

oonoi 

00030 

CT 

00001 

00027 

DELTA 

00006 

00052 

FRED 

00006 

iflao 

00003 

I NCSA VE 

00005 

000A2 

jflag 

00003 

kFlag 

00008 

00010 

00037 

00039 

M 

ooooa 

00010 

mFlag 

00006 

0003b 

00054 

nPASS 

00008 

00010 

00012 

nhep 

00005 

000A3 

N«UN 

00006 

0001  A 

000  1 6 

00016 

00023 

00U29 

00031 

00062 

NRUNX 

00006 

00010 

00063 

OOOoJ 

nSen 

00003 

00050 

00053 

OOOBB 

NTKG 

00001 

00018 

00044 

NUM 

00006 

0006a 

PI 

00007 

00015 

00019 

P 12 

00007 

P102 

00007 

RALA 

00002 

00019 

RALROT 

OOOOA 

000A0 

RAnGF. 

00006 

RCS 

00002 

RTA 

00002 

00324 

RTEmP 

00002 

00029 

RVA 

00002 

00023 

RAO 

ooooa 

RAA 

00002 

0002C 

pro 

OOOOA 

RYA 

00002 

00021 

R/A 

00002 

00022 

SAVE 

00006 

00015 

00016 

00017 

ooo?y 

00031 

SNCPA 

00006 

00017 

TA 

00OO1 

00024 

terp 

00001 

00029 

O0030 

TLR 

00006 

00047 

TSAvE 

00005 

VA 

00001 

00023 

wSflvt 

oooob 

xO 

00003 

CC033 

XA 

00001 

00020 

0002  F 

XK 

00006 

00016 

v M A^u  V 


NOL  FORTRAN  (l.U) 


PROGRAM  SI  * IL A T £ 


*M£AN 

YO 

YA 

ZA 


00006 

0 0 0 .1 3 

00001 

00001 


000J8 

0003* 

00021 

00022 


00027 


COMMON  variables 

••NONE** 

PROGRAM  VARIABLES 


BIAS 

00015 

00038 

000*0 

cos 

00025 

I 

00032 

00033 

0003* 

00035 

00036 

000*6 

000*7 

000*8 

INPUT 

00009 

J 

000*1 

000*2 

000*3 

MS 

00050 

00051 

00053 

0005* 

00058 

NT 

00018 

00019 

00019 

00020 

00020 

00023 

00023 

0002* 

0002* 

0oo25 

00027 

00027 

00027 

00027 

Ooo** 

OUTPUT 

00061 

StNCHK 

00051 

SIN 

00026 

SPL 

00059 

TIME 

000*5 

00051 

00052 

00052 

NOL  FORTRAN-  (1.0) 


« 


00000 


00001 

00001 

00002 

00002 

00003 

OOOOA 

00005 

00005 

00006 
00006 

00007 

00008 

00009 

00010 
0001  1 
00012 
00013 
000U 


00015 

00016 
00017 
00013 
00019 
C9021 


SUBROUTINE  INPUT 

« 

JONATHAN  VALVANO  03/13/75  » 

• 

THIS  ROUTINE  INPUTS  INITIAL  PARAMETERS.  ° 

ALL  angle  INPUTS  are  IN  DEGREES.  ■» 

Q 

**«*******»**«<hmm» »»•••«•«•«•««•••••••••••«••••••••••••••»<>•••*» 

COMMON  /TRC'T//  ALA(3)  .XA(3)  *YA(3)  ,ZA(3»  » 
l TA(3) » u A < 3 ) .AT (3) »B  T ( 3 ) *CT(3) * TCmP.CS.nTRG 

COMMON  /RTR(jT //  RAtAO)  ,RXA(3)  .Hya<3)  ,R2A(3)  . 

1 RTA(3) • R V A ( 3 ) * RTE  MR .PCS 

COMMON  /SEN//  NSEn. XO (3) . TO (3) . AL«Ol (3) * IFLAG. JFlAG 
COMMON  /RSEN//  RAO (3) *«yo (3) iRALROT (31 

COMMON  /RE®//  TSAVE  (3.3.50)  .mSAVE  <3i  3.50)  .(.SAVE  (3. 3**0)  » 

1 NRtP<3.3) . TNCSAVE (3.3) 

common  /STATE//  TL« (7) .ALR  CD  *mFlag <31 «FREQ (2) * 

1 sinS.xmean.xk.sncRa  .range  . OELT  a *num  «nrun  *nrunx  .Save  ( in  * ion ) 

common  /COr-  6 r//  P1.PI02.PI2 
COMMON  /OPTIONS//  KFLAG.M.NPASS 
DATA  /CONST/  (PI=3. IA1S926538) 

DATA  /C0N5T/  (PI02=l .570796327) 

DATA  /CONST/  (PI2S6.2Q3185307) 

OATA  /REP/  ( NREP ( 1 ) «9 ( 0 ) ) 

DATA  /STATE/  (TlR ( 1 ) *3 (-5C.0) ) 

DATA  /STATE/  ( AlR ( 1 ) =3 < 0 . 0 I ) 


RE AO  SIMULATION  OPTIONS.  * 

NUM  is  THE  NUMBER  OF  RUNS  IN  A SET.  ■» 

« 

NUM»1 

R£AU  200.  NOYES, (SAVE ( T .NUM) , 1=1,10) 

FORMAT  (I5.F5.0.F10.4.7F5.0.F10.O) 

NUMsNom* 1 

IF  (NOYES  .El.  1)  GO  TO  279 
NUMaNUM-2 


NOL  FORTRAN  (1.0) 


SUBROUT INE  INPUT 


J 


00022 

00023 

0002<* 


00038 


00039 

00040 

00041 


READ  200.  ' TUG 
20  0 FORMAT  (15) 

00  225  NTs'.NTHG 

• « 

« READ  REAL  TARGET  CHARACTERISTICS.  ° 

a a 

aaaaaaacaaaaaaa»aaaaaaaaaua«aaaaaaaaaaaaaaaaaaaaaaaaaaaeaaaaoaaae 


c 

c 

c 

c 

c 

c 

c 


0002S 

READ  220.  aalaD.RXA(nT) 

00026 

220 

FOHMAT  (6F10.2) 

00027 

RALA  (NT  ) =RALAl)**PI/  180 . 0 

00026 

225 

CONTINUE 

00029 

READ  230.  nSEN 

0 0o3o 

230 

FORMAT  (15) 

00031 

DO  250  NSrl.HSEN 

**#*aa****a*aaaaa*a*a***aaaaaa»#**aaaa*a*****aaaaaa*a#**»#*aaaeaa 
• • 

« READ  REAL  SENSOR  CHARACTERISTICS.  « 


00032 

READ  240.  °X0(NS) .RYP (NS) .RALROTO 

00033 

2a0 

FORMAT  (3F10.2) 

00034 

RALROT (NS) =RALROTD«P 1/180.0 

00035 

250 

CONTINUE 

00036 

READ  290.  RANGE. DELTA, FREQ(1> »FRE0(2) 

00037 

290 

FORMAT  (SF  1 0.2) 

C 

C 

C 

C 

c 

C 

c 

c 

c 

c 

c 


aaaaaaaaaaaaaaaaaaaaaaaaaa«aaaaa»aaaaa«0aaaaaaaaaaaaaaaaaaaaoaa 

NORMAL  IS  THE  SUBROUTINE  THAT  GENERATES  GAUSSIAN  NOISE. 
HERE.  IT  IS  CALLED  JUST  TO  INITIALIZE. 


CALL  NORMAL  (ERROR) 

RCS  IS  THE  REAL  SPEED  OF  SOUND. 

RCS=331 ,36*0.t)096*RTEMP 
RETURN 
END 

NOL  FORTRAN  DIAGNOSTIC  RESULTS  - FOR  INPUT 


NO  ERRORS 
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1 ■«  . 


NOL  FORTRAN  (1.0) 


SUHHOUTINt  INPUT 


OATA  variables 


ALA 

oooni 

ALH 

Cti'.nntt 

00014 

ALROT 

00  003 

ASAVE 

OPOOS 

AT 

0P001 

BINS 

00006 

bt 

00001 

Cb 

0P001 

CT 

OPOOl 

DELTA 

00006 

00036 

FREQ 

00006 

00036 

00036 

If  LAG 

000O3 

INCSAVE 

00005 

JFLAG 

0P«O3 

kFlag 

00008 

M 

00008 

MF'LAG 

00006 

NPASS 

00008 

nhep 

00005 

00  0 12 

nRun 

00006 

nwunx 

00006 

npEn 

00003 

00029 

00031 

nThg 

00001 

00022 

00024 

NUM 

00006 

0P015 

UOOlB 

000  Id 

PI 

00007 

00009 

0002  t 

00034 

PI2 

00007 

00011 

P 102 

00007 

00010 

rala 

00002 

00027 

RALROT 

000  04 

0C034 

RANGE 

00006 

00036 

RCS 

00002 

00039 

rta 

00002 

OP025 

ptemp 

00002 

00036 

00039 

RVA 

000P2 

00025 

RXO 

ooooa 

00032 

RXA 

0C002 

00025 

RYO 

00004 

0O032 

RYA 

00002 

00025 

RZA 

00002 

0002b 

SAVE 

00006 

00016 

SNCPA 

00006 

TA 

OCOOl 

TEMP 

00001 

TLR 

00006 

00013 

TSAVE 

00005 

V A 

00001 

«SA  VE 

00005 

XO 

00003 

XA 

00001 

XK 

00006 

xmean 

00006 

yo 

0 P 0 0 3 

< 
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NOL  FORTRAN  (1.0) 


SUBROUTINE  INPUT 


Tft  OOOnl 

Z*  00001 

common  VARIABLES 
■**NONE»« 


PROGRAM  VaRIASuES 


ERROR 

I 

normal 

NOTES 

NS 

NT 

RALAD 

RALROTO 


00030 
000)6 
00036 
00C16 

00031 
0002A 

00025 

00032 


00016 

oooiv 

00032 

00025 

00027 

0003a 


00032 

0002s 


0003a 

00025 


00^25 


f 

J 


NOL  FORTRAN  d.O) 


SUZHOU  TINE  SFNCHK  ( NS  » T AU .NT) 


00001 

00001 

00002 

00003 

00003 

00004 

00004 

00005 


JONATHAN  VA(_VANO 


03/1 b/75  4 


This  ROUTINE  CHECKS  TO  SEE  IF  THE  StNSOR  Should  * 
REPORT  AT  THIS  TIME.  IF  IT  DECIDES  TO  RfcPORl  TH£n  IT  «ANES  « 
THE  APPROPRIATE  ENTRIES  INTO  The  ARRAYS.  (TSAYt.ASAVE.»SAvE* 


COMMON  /RTROT//  RALA(3) »R*A(3) tRYA(3) ,RZA(3) , 

RTA (3) .RVA (3) .RTEMP.PCS 

COMmun  /HSFN//  R*0  (3)  .RYO (3) .RALROT (3) 

COMMON  /REP//  TSAYEO.3.50)  . ASA VE < 3 ♦ 3, 50)  « fcSAVfc  ( 3 « 3 .5" ) , 
nREH (3.3) , TNCSAvE (3,3) 

COmmun  /STATE//  TLR(3) ,ALR(3> «MFlA6(3) ,FRE(5(2) • 

BlNP*  XME4N. XK.SNCPA, RANGE  * DEL T A , nUM * NHUN . NRUNX , SAVE (10,100) 
COMMON  /CONST//  P I , PJ 02 , P 12 


THE  SENSOR  Can  ONLY  REPORT  EVERY  FREQ ( 1 ) SECONDS  IF  TmE 
TARGET  IS  CHANGING  BINS.  IF  IT  HiS  NOT  BEEN  AT  LEAST 
FREO(l)  SECONDS.  CONTROL  IS  RETURNED  TO  SIMULATE, 

AND  The  SEnSOR  DOES  not  REPORT. 


00006 


IF  ( (TAU-TLRINS) ) .LT.  FREQ ( 1 > ) RETORn 


time  tau  is  i*hen  the  sound  originatls  from  the  target. 
ratau*real  x position  of  THE  Target  at  TIMF  Tau. 
RYTAUaHEAL  Y POSITION  OF  THE  TARGET  AT  TIME  TAU. 
RALTAUaPEAL  ALPHA  ANGLE  TO  THE  TARGET  AT  TIME  lAU. 


OOOOS 

00009 

00010 
00011 


RXTAUaRXA ( NT ) ♦ R V A ( NT ) * ( T AU-RT A ( N T ) ) *COS (P 102-HmLA (nT1> 
RYTAurRYA (NT) *RVA ( NT ) * ( T 6U-R T A ( NT ) ) *S I N ( P I D2-R ALA (NT) ) 
RALTAUaPID2  -ATAN(  ( R Y T AU-R Y 0 ( NS > ) / < RX T AU-R A 0 ( NS ) ) ) 

IF  (HXTAU  .LT.  RXO(NSI)  RALTAUaRALTAU*PI 


OXY2  IS  THE  DISTANCE  FROM  THE  SENSOR  TO  THE  TARGET.  IT  IS  • 
THIS  DISTAr.CE  THAT  THE  SOUNO  TRAVELS  (FROM  TARGET  TO  SENSOR* 


00013 


OXYZaSQRT ( (RXTAU-RXO (NS) ) **2» (RYTAU“RY0  <NS))**2»RZA(nT>*»2> 


NOL  FORTRAN  (1.0) 


SUHROUT I Nt  SEnChk  ( NS  * T AU . nT ) 


000U 

00016 

00017 

00013 


IF  Tut  TARGET  IS  OUT  OF  RANGE  FOR  THIS  SENSOR » 
SET  MKlAG  TO  1 ANO  RETURN.  NO  REPORT. 


IF  (UXYZ  ,!.T . RANGE)  GO  TO  300 
“FLAG  (NS)  *1 
RETuHn 
mFLmG (NS) *0 


TIRE  IS  THE  TIME  *h£n  THE  SOUNO  REACHS  The  SENSOR. 
IT  IS  THE  REPORT  TIME. 


00019 


TIMEsI AU*DXYZ/KCS 


ALTAU  „ILL  HE  ThE  REPORT  BEARING 


00020 


AlTAUsHALTAU-RALROT (NS) 


* CALCULATE  SIGNAL/NOISE  <SN) 

• aoo  Gaussian  error. 


00021 

00022 

00023 

0002A 


SNsSNCPA/ (OXy2»1 .0) 
XSIGha=xk/5URT (SN) 
call  normal  (ERROR) 
ALTAUsa|_TA.|*XH£aN*XSIGmA«£RROR 


0 0025 


ALTAU  is  ADJUSTED  TO  FIT  INTO  A BEARING  BIN. 


ALTaUs (PI2/8INS) *FLOAT < IF  I X (B INS* ALT AU/P 12 »0 . 5 ) ) 


’ •*  jr*&~ . J3* 


NOL  FORTRAN  (1.0) 


SJBHOUTINE  SENChK  (NS,  T A'-J.nT) 


00026 


00027 

00027 


00029 

00031 

00032 

00033 

00034 
0 003S 

00036 

00037 
00036 
00039 


NO  ERRORS 


C 

C 

C 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 


c 

c 

c 

c 

c 

c 

c 


ft 


o «>  » • o o «> 


m lb  T h£  apK,HTIN<3  r^CTOW  ^aSSLO  FwOM*  THL  $E>:S 


w=.001 

« 

IF  The  bearing  has  not  changed  since  the  last  report  « 

(ALTau=ALB)»  Then  Thf  SENSOR  HUST  wait  at  LEASI  FRFQ(?>  * 
SINCE  the  last  REPORT.  w£  KNOW  THE  SEnSOR  has  «aITEo  * 

FREOll)  SECONDS  (FROvi  m^OVE),  SO  wF  WILL  RFPOR I IF  EITHER  « 

i.  the  bearing  has  Changed  «■ 

Oh  2.  The  r ivt  DIFFERENCE  .Gf.  FRfcw  <2) 

o 

IF  ((  TAU-TiR(NS))  .lT.  FREQ (2)  .AND. 

1 ALTAO  ,EQ.  ALR(NS))  RETURN 


THE  SENSOR  IS  now  REPORTING. 


IF  <NWEP( NS. NT)  ,GE.  so)  RETURN 

TLR(NS)sTA'.j 

ALR (NS) rALTAU 

NREP (NS  » N T 1 aNHEP (NS.NT) *1 

N=NREP(NS.nT) 

TSAvE(NS,NT,N)=TIME 

ASAVE (NS.NT.N) =ALTAU 

WSAVE(NS,NT»N)=W 

return 

EN0 


NOL  FORTRAN  DIAGNOSTIC  RESULTS  - FOR  SENCHK 


B-2  5 


nol  fortran  u.O) 


SUUHQUT I NF  SFNCHK  <nS.TaU«nT> 


data  VAR  I AdLES 


ALP 

00004 

00027 

00032 

ASAvb 

00003 

0003b 

BINS 

00004 

00025 

00025 

oelta 

00004 

FREQ 

0.0004 

00006 

0002  7 

InCSAvE 

00003 

mFLAG 

00004 

00016 

oooia 

N«EP 

00003 

00029 

00033 

00033 

nRun 

00004 

nhunx 

00004 

NOM 

00004 

Pi 

00005 

00012 

PI2 

00005 

00025 

00025 

PID2 

00005 

00008 

00009 

00010 

rala 

00001 

ooooa 

O0009 

RALROT 

00002 

00020 

RANGE 

00004 

00014 

RCS 

• 00001 

00019 

rTa 

00001 

ooooa 

00009 

rtemp 

ooooi 

RVA 

00001 

ooooa 

00009 

RXO 

00002 

00010 

00011 

00013 

RXA 

00001 

00008 

RVO 

00002 

00010 

00013 

RYA 

ooooi 

00009 

R2A 

00001 

00013 

SAVE 

00004 

SNCPA 

00004 

00021 

TLR 

00004 

00006 

00027 

00031 

TSAVE 

00003 

00035 

xSAvE 

00003 

00037 

XK 

00004 

00022 

xmean 

00004 

00024 

COMMON  variables 
••none** 


PROGRAM  VARIABLES 


ALTAU 

00020 

00024 

00024 

0002S 

ATAN 

oonio 

cos 

00003 

0*YZ 

00013 

00014 

00019 

00021 

error 

00023 

00024 

FLOAT 

00025 

IF  I X 

00025 

N 

00034 

00035 

00036 

00037 

normal 

00023 

NS 

oocno 

00006 

000  10 

oooio 

00025 


oonl  1 


nol  fortran  ii.oi 


SUBROUT I Nfc  SEnCMK  (NS.TaU,nT) 


00020 

00027 

0002  f 

00029 

onn3i 

00035 

0003b 

00037 

nT 

ooono 

0 0 0 0 B 

00008 

00008 

0 oooB 

00013 

00029 

00033 

0G033 

0 on  3*» 

RA(_T AO 

000  1 0 

00012 

00012 

00020 

RXTAU 

00O09 

00010 

00011 

0 C 0 1 3 

R7TAU 

00009 

00010 

00013 

SIN 

00009 

SN 

00021 

00022 

SJRT 

00013 

00022 

TAU 

ooooo 

00006 

00008 

00009 

00019 

TIM£ 

00019 

00035 

w 

00026 

00037 

XSIGMA 

00022 

0002A 

NOL  FORTRAN  ( \ .0) 


00000 


C 

c 

c 

c 

c 

c 

c 

c 


SUBROUTINE  output 


JONATHAN  vAlv/ANO 


03/18/75  « 


THIS  ROUTINE  OUTPUTS  RESULTS. 

ALL  AnulE  OUTPUTS  arp  IN  DEGREES. 


00001 

COMMON  /TRGT//  ala (3) . <A (3) »YA (31 ,ZA (3) , 

00001 

1 

TA  (3) . YA (3) .AT (3) .BT (3) .CT (3) . IEmP.CS.nIRG 

00002 

common  /R  T °G T//  RA(_  A ( 3)  .RXA  (3)  ,RYA  (3)  , R2a  (3)  . 

00002 

1 

RTA(3l « P V A ( 3 1 *RTEMP*PC5 

00003 

COMMON  /SEn//  NSEn.XO (3) ,Y0 (31 .ALPOT (31  * IfLAO. JFlAG 

0000* 

common  /RScN//  RXO (3) «PY0 (3) tHALROT (3) 

00006 

COMMON  /RE0//  TSAVE  (3, 3.50)  .ASAvE  (3*3.50)  .LSavc.  (3.3. 5r.)  . 

OOOOS 

1 

NR£P ( 3 . 3 ) , TNCSAVE13.3) 

00006 

COMMON  /STATE//  Tl« (3)  . ALP (3) *MFtAG  (3) *FREO (2) * 

00006 

1 

8 InS*XMF.AN.  XK.SNCPA.RiuiGE  * CELT  A , NUm  * NRUN  * NRUNX  * S A VE  (10.100) 

00007 

COMMON  /OPTIONS//  KFcAG.M.NPASS 

00008 

common  /CONST//  PI*PI02,PI2 

00009 

PRINT  604.  NRUNX 

0001  0 

604 

FORMAT  ( lrtl .50X,5mROn  .15) 

000  1 1 

IF  (NFlAG  .EU.  0)  print  6 1 1 

00013 

611 

FORMAT  (IH3, 10X, 15H81 AS  CALCULATED) 

0001  A 

IF  (KFLAG  ,EQ.  1 ) PRINT  612 

000 16 

e>12 

FORMAT  ( 1H3.10X. 12R0IAS  INPUTED) 

000  17 

PRINT  615 

00018 

615 

FORMAT  <IH  . 10X, 14HREPORTED  »sl.l7x. 

00018 

1 

32MCALCULATEO  w=EXP (- ( RXY/ 1 00 0 ) ®«2 ) ) 

00019 

PRINT  614,  NOASS. M 

00020 

614 

FORMAT  (1h  . 10X,  IdHNUMBER  OF  PASSES  .I8.5X, 

00020 

1 

21H1NCREMEUT  FACTOR  M , IB) 

00021 

XMEand=xmean«180.0/pi 

00022 

PRINT  b02. XMEAND. RANGE 

00023 

602 

FORMAT  (lH  . 10X ,4hmpan,  14X.F8. 1 .5X.5HRANGE . IoX .Fh.O ) 

00024 

PRINT  603.  XK.SNCPA 

00025 

603 

FORMAT  ( 1 H . 1 0 X . 8HK  h AOTOR. 1 OX.F8.4 *5X. 10HS/N  Al  CP A . 1 1 X . F8 . 7 ) 

00026 

PRInT  600.  FREQ ( 1 ) . FRFO  < 2 ) 

00027 

600 

FORMAT  ( 1h  , lox,  IbhchanGE  CYCLE  TImE  .Fb.2, 

00027 

1 

5X.21HN0  CHANGE  CYCLE  TlME  .FB.2) 

00028 

PRInT  6C 1 * HlNS. DELTA 

00029 

601 

FORMAT  ( 1 H . 10X, 18HNUMBEP  OF  BINS  .F8.0.5X. 

00029 

1 

21MT1ME  INCREMENT  . F8 , 2) 

B-30 


pnpf  IV 

l»un  • 
fEsv&H  < u-t 


■ »-  v ^ 

— - 


NOL  FORTRAN  (1.0) 


subroutine  output 


00030 

00031 

00032 

605 

00032 

00033 

00034 

00035 

606 

00036 

00037 

00038 

607 

00039 

61 0 

000*0 

000*1 

000*2 

620 

000*3 

000*4 

621 

000*4 

00045 

00046 
000*7 

622 

000*8 

000*9 

oooSo 

623 

0005  1 

00052 

00053 

00054 

00055 

624 

00056 

00057 

00058 

625 

00059 

00060 

616 

00061 

650 

00062 

00063 

NOL 

00  610  NTs i , nTHG 
print  60S . NT 

FORMAT  ( iHl, IOA.ShTAHG  ,15. 

56M  XA  YA  ZA  VA  COURSE  T£MP  Cl 

RALAUaRALA I NT ) * 1 30 . 0/P  I 

PHI  M e>06.  HXA(NT) .RYA(NT) .R/AINT)  ,RVA(NT) ,Ral«O.RTEmp.RCS 
FORMAT  (1h  .Iox.Ighreal  * 7F  8 • 2 ) 

ALAU=ALA(NT)»1M0.0/PI 

PRIM  607.  XA (NT) . YA (NT) .ZA (NT) .VA (NT) . ALAO. TEMR.CS 
FORMAT  (1H  . 10X,  I0HINPUTEO  »7F8.2> 

COM  JNUE 

00  oSO  NS=1 . NStN 
PRINT  620.  NS 

FORMAT  ( 1H3 . 10X, 1 ahsenSOR  NUMBER  .15) 

PRINT  621 

FORMAT  (lrt  ,l!)X,20X, 

36pi  XO  YO  ALROT) 

RALHUIOsRALROT (NS) *1 AO.O/PI 
PRINT  o22.  RXO(NS) .RYOfNS) .HALROTD 
FORMAT  (In  , 10X.4HREAL . 16X.3F 12.5) 

ALHO TOxAUR^T (NS) * 1 AO • O/Pl 

PRINT  623.  XO(NS) .TO (NS) .ALROTO 

FORMAT  ( X H .10X,l0HCALCULATEO.10x.3f;12.5) 

OX=HXO (NS ) -AO (NS) 

DYsHYO  K4S) -YO(NS) 

OAL=m ALROTO- alROTO 
PRINT  o2A.  DX.OY.OAL 

FORMAT  (lH  , IOX, 10M0IFFERENC£*  10X.3F 12.5) 

ORsSURT (DX**2*DY**2) 

PRINT  625.  OR 

FORMAT  ( 1HP , lox, 12HRA0T At  ERROR .HX.Fi2.5l 
PRINT  616.  ( INCSAVE (NS. I ) . 1*1.3) 

FORMAT  <1H  .10X.10HINCREMENTS.10x. 3U2) 

CONT  InuE 

RtTuRN 

END 


NOL  FORTRAN  (DIAGNOSTIC  RESULTS  - FOR  OUTPUT 


NO  ERRORS 


G(!SY  *'.',‘1’ 


jrTlg  • :V  r 

Cftftili  5 U«-U  t I ) W *4  vlx  f « ' 


. sc 


N0|_  FORTRAN  11,0) 


SUBROUTINE  OUTPUT 


DATa  variables 


ALA 

ALP 

ALROT 

ASAVE 

AT 

BINS 

61 

CS 

CT 

DtLTA 
FREO 
IFLAG 
INCSA vE 
JFLAG 

kflag 

M 

MF  LAG 

npass 

N«EP 

N«UN 

NMUNX 

ngen 

NTRG 

NUM 

PI 

PI2 

PID2 

rala 

RALROT 

range 

rcs 

rta 

RTEmP 

RVA 

RXO 

RXA 

RYO 

RYA 

R/A 

save 

SNCPA 

TA 

TEMP 
TLR 
TSAVE 
(V  A 

MSA  VE 

xo 

XA 

XK 

XMEAN 

YO 


oonoi 

00036 

ocnof 

00003 

00005 

oooni 

00048 

OOOOB 

00001 

00026 

000O1 

00001 

00037 

00006 

00028 

00006 

0oon3 

00026 

0002b 

00OO5 

00003 

DC  059 

0 0 0 o 7 

0001  1 

00014 

000  0 7 
00006 

00019 

00007 
00005 
0000  6 

00019 

00  0 06 

00009 

00003 

00040 

0 0 0 0 1 
00006 

00030 

00008 

00008 

00008 

00021 

00033 

00002 

00033 

00004 

00045 

00006 

00022 

00002 

00002 

00034 

00002 

00034 

00002 

00034 

00004 

00046 

00051 

00002 

00034 

00004 

00046 

00052 

00002 

00034 

00002 
00  0 06 

00034 

0000b 

00001 

00024 

00001 

00006 

00005 

00037 

00001 

00005 

00037 

00003 

00049 

00051 

00001 

00037 

00006 

1)0024 

00006 

00021 

00003 

00049 

00052 

pgpy 

HU  |I» 

f ' 

X V ‘ Jt  , S*S>~ 


r 

L 

• 

NOL  FORTRAN  (\.0) 

subroutine  output 

, 

YA 

000,11 

00037 

Z A 

00001 

00037 

1 

j 

r 

COmmON  VARIABLES 

1 

1 

«*NQn£«* 

j 

program  variables 

J 

ALAQ 

00036 

00037 

r 

ALRorn 

00048 

00049 

00053 

OAL 

00053 

0005a 

or 

000=56 

00057 

# 

0* 

00051 

00054 

0 0056 

1 

OY 

00082 

00054 

00056 

§ 

I 

01158 

00059 

I 

NS 

00040 

00041 

00043 

00046 

Ooo-6 

i 

NT 

ooosi 

00052 

00052 

00059 

; 

00030 

00031 

00  033 

0003** 

0 0 f.  3 4 

00037 

00037 

00037 

ralao 

00033 

00034 

J 

RALROT0 

00045 

00046 

00053 

SURT 

00OH6 

• 

XM£aN0 

00021 

00022 

\ 


NOL  FORTRAN  (i.O) 


00000 


SUBROUTINE  SPHnS) 


JONATHAN  V AL  V AnO 


ThIS  is  Thf  SENSOR  POSITION  locator  routine. 


n3/l S/7S 


Inputs 


OUTPUTS 


NS  NU*BErt  OF  sensor 

NP4SS  NUMBER  of  PASStS  USEO 

nTOG  number  of  targets 

TSAVE (NS.NT »nR) =TIME  OF  REPORT 
ASAVE ( NS  « NT * \ R ) * ANGlE  OF  REPORT 
•SAVE (MS*nT ,nR) =«  UF  RfpOhT 
NREP (NS, NT) sNUMbER  OF  REPORTS 

xO(NS)  X POSITION  OF  The  SEnSop 

YO(NS)  Y POSITION  OF  The  SEnSOP 

ALROT(NS)  angle  ROTATION  BIAS 


GIVEN  THE  PE°ORTS  SAVER  IN  THE  ARRAYS  THIS  ROUTINE 
CALCULATES  T«E  SEnSOR  POSITION  ANO  6US  ANGLE. 

THE  UUS  IS  THE  FIRST  THING  CALCULATED.  IT  USES  THPEF 
REPORTS  ANO  USING  ANGLE  DIFFERENCES  CALCULATES  Thf  aiAS. 
THE  SENSOR  POSITION  IS  CALCULATED  By  A LEAST  SOUAPFS 
FIT  UF  A POINT  TO  THE  MANY  LINES  (ONE  FOR  EACH  REPORT) 

FROM  The  TARGET  TO  Thf  SENSOR. 

ENTER  CALCULATES  THESE  LINES  AND  MAKES  THE  aPPROPRIATF 
SUMS  INTO  Al2fBI2tAIBT.AICI.BICl.  Th£  SENSOR  POSITION 

is  a simple  relation  of  these  variables. 

THERE  IS  TwE  POSSIBILITY  OF  INPUTED  THE  BIAS  (AlpOT.) 

IF  This  option  is  Taken,  KFLAG  ShOulu  dt  SET  (KFlAG*1>. 

IF  KLAU  IS  RESET  (KFLAGsO)  THEN  THF  PROGRAM  vt  ILL  CALCULATE 
ITS  0»N  BIAS. 


00001 

00001 

00002 

00003 

00003 

00004 

00005 

00006 


COmmOi'.  /TR,-,t//  ala  (3)  , xa  (3)  . ya  (3)  t ZA  (3)  ,TA  (3)  , va  (3)  , 

AT  (3) .BT ( 3 > ,CT (3) . TEMP .CS t N TRG 

COMMON  /SEN//  NSEN. X0  (3) , YO (3)  .AlROT (3) » IFLAG. JFLAO 
COMMON  /REP//  TS.WE<30.50>  . ASAVE  ( 3 • 3 1 50 ) . wSA VE ( 3 . 3 *SO > t 
NHtP (3.3), TnCSAVE (3.3) 

COmhun  /CO'. ST//  PI.PID2.PI2 

COmhOn  /SU-S//  AI2.RI2.AIBI. AICI. 8ICI 

COMMON  /OPTIONS//  KFLAG.M.NPASS 


MW  ^ V r,  vxj 


wjr.  * 


NQl  FOPTSAN  (l#0) 


SUBROUTINE  SPl ( N5 ) 


« 

WhEn  CALCULATING  The  BIAS  IT  IS  BETTER  NOT  TO  USE  • 

SE  JutNCI *l  REPORTS  BECAUSE  THE  AnGLP  DIFFERENCES  ARr  - 

E I T HtH  TOO  SMALL  or  ZERO.  THEREFORE  «E  «ILL  Increment  • 

THROUGH  THE  ARRAYS  STEPPING  MORE  THAN  ONE.  INC  IS  ThF  ® 

VALUE  OE  T-E  INCREMENT  for  EACH  TARGET  The  SENSOR  SA . . - 

IF  Inc  ( 1 ) = a then  WHEN  wE  LOOK  AT  Thc.  RERORfS  Of  TARGET  1*  ® 

wE  » I LL  STEP  Through  by  a < i,S»9.13«...l  . « 

IN  OH0ER  TO  uSE  AS  MUCH  OF  ThE  OaTA  AS  POSSIBLE.  wE  « 

will  step  through  the  arrays  again  but  starting  „ith  ?.  ® 

THEN  3,  THEN  4.  IF  NREP  (NS.  I ) =S0  Then  IncU)  wDulO  rE  1 3 * 
ANO  WE  WOULD  LOOK  AT  Th£  REPORTS  In  THIS  ORDER—  • 

1.14.27, *0  ?, 15.29,41  3,16,29.41  ....  13.26.39  * 

BIAS  CALCULATIONS  USE  REPORTS  IN  GROUPS  OF  THREE.  ® 

POSITION  CALCULATION  S USE  EACH  REPORT  SEPERATEly.  « 

o 


00007 

00006 

00009 


OO  400  NT=! , N T R G 

INCSAVE (NS.NT) =1 *nREP (NS.NT ) /M 

CONTINUE 


00010 

00011 

00012 


00013 

00014 

00015 

00016 
0001  7 
00018 
00019 


d 

THL  POSITION  CALCULATION  CAN  NOT  BE  DONE  wIThOJT  A 81 *S  * 
CALCULATION  . BUT  THE  BIAS  CALCULATION  CAN  BE  UOnE  with  * 
OR  WITHOUT  A POSITION  CALCULATION  . THE  BIAS  CALCULATION  ® 

IS  MURE  ACCURATE  when  POSITION  IS  KNOWN.  TO  KEEP  « 

TRACK  OF  WHICH  CALCULATIONS  HAVE  BEEN  DONE  FLAGS  * 

are  used.  Iflag»o  means  no  bus  calculation  • 

iflag=i  means  a bias  calculation  ® 

JFLAG=0  means  no  position  CALCULATION® 

jflag=i  means  a position  calculation  • 

KFl.AG  = 0 MEANS  BIAS  To  BE  CALCULATtU  • 

KFlAG*1  means  BIAS  HAS  HtEN  INP’JTEO  ® 


IFLAGwO 

JFLAG=0 

00  490  NPs ] .NPASS 


EACH  PASS  STARTS  WITH  FRESH  SUMS  BUT  USES  ThE  CALCULATIONS 
FROM  THE  PREVIOUS  PASS. 


A I 2s0 , 0 

BI2  = 0 . 0 
AIBI=0.0 
AICI=0.0 
BICI*0. 0 
BSI»0.0 

Wl=0.0 


copy  mn,r,r  T 

. 


• •A 


N0|_  FORTRAN  (1.0) 


SUBROUTINE  SRL<NS> 


00020 


00021 

00022 


00023 


C 

C 

C 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 


c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 


IF  OATA  from  Two  OH  MORE  TARGETS  IS  A V A II ABLE  THEN 
CALCULAT  IONS  APE  GENERALLY  “(OPE  ACCURATE. 
hEPEi  «E  loop  Through  fop  each  TARGET. 


00  AUO  NT*1,NTRG 


#****0 ********<>*********«*****************  ****** *******  ********  o 

« 

NRPT  Is  the  NUMBER  OF  RE°OPTS  OF  THIS  TARGET.  * 

N IS  The  INCREMENT  used  WITH  Th£  REPORTS  OF  This  TaPC-ET.  • 


NRPT*NRPP (NS.NT) 

NsINCSAvE  (\S.;<T> 

*«««•**»••»««*«**«••»«»«»*«*»•»«••«*«««*«••***«•«••••«•««*• **»v  9 

• 

IF  w£  afl£  GOING  TO  INCREMENT  dY  N THEN  THERE  MUST  BE  » 

AT  LEAST  3*N  POINTS  IN  THE  ARRAYS  .IF  NOT  GO  TO  NEXT  TARGET* 


IF  (NRPT  ,lT,  3*N)  GO  TO  ABO 


3-37 


COPY  mu 


' - v" f ” i r r rr 

1 LiW.i  I i uLii 


(»-k.  i. 


i ttifiivuiitn'i 


Wi*  ■ W.Au.J 


'a 


NOL  FORTRAN  (1 . 0) 


SUBROUTINE  SPL(NS) 


I 


c 

c 

00025  DO  470  NFHSTsl.N 

C 
C 

c 

c * * 

c • ® 

C « Nl  15  THE  NUMBER  OF  The  FIRST  REPORl.  * 

C * N2  IS  ThE  »"UmBER  OF  T-E  SECOND  REPORT.  ® 

C * N3  IS  ThE  NUMBER  OR  The  THIRD  REPORT..  * 

C « • 

C * Tl  IS  THE  TIME  OF  THE  FIRST  REPORT.  • 

c « T2  IS  The  time  of  The  SECOND  REPORT.  • 

C * T3  IS  THE  T!m£  of  The  THIRD  REPORT  • * 

C * • 

C * (Xl.Yl)  IS  The  TARGET  POSITION  AT  1 he  FIRST  REPORT.  « 

C « (X2.Y2)  is  ThE  TARGET  POSITION  AT  The  SECOND  REPORT.  ® 

C * (X3.Y3)  IS  The  TARGET  POSITION  AT  THE  THIRD  REPORT.  « 

C ♦ * 

C * ALPHA  1 IS  THE  reported  REARING  OF  THE  FIRST  REPORT.  • 

C * ALPHA2  IS  THE  REPORTED  BEARING  OF  THE  SECOND  RtPORT.  * 

C * ALPHA3  is  THE  REPORTED  BEARING  OF  THE  THIRD  REPORT.  • 

C * ® 

C * *1  IS  Th£  -SIGHTING  FACTOR  ASSOCIATED  wITh  THE  FIRST  REPORT® 

c * w2  is  the  -eighting  factor  associated  with  the  second  report® 

c * W3  IS  the  .sighting  factor  associated  with  the  Third  report® 

c * « 

c * TRETAl  IS  the  angle  DIFFERENCE  between  FIRST  AN o second  * 

c * THETA2  IS  THE  ANGLE  DIFFERENCE  BETwEEN  THE  SECOND  and  THIRD® 

c * • 

c • d12  is  the  DISTANCE  TRAVELLED  BETWEEN  The  FIRST  and  second® 

c * D23  IS  the  DISTANCE  TRAVELLED  BETWEEN  THE  SECONO  AND  THlRO  ® 

C • * 


k 


NOL  FORTRAN  (1,0) 


SUBROUIInF  SPlINS) 


E 

! 


J 


r 


000*6 


000*7 


C 

C 

C 

c 

c 

c 

c 

c 

c 

c 

c 

c 


c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 


THE  BIAS  ALGORITHM  WILL  not  work  IF  ThETAI  EQUALS  ZERO, 
THE  lHLREMCNr  IS  INCREASED  AND  *E  START  OVER  A o a I n , 


00036 

IF  (ThETAI  ,nE.  0.0)  GO  TO  410 

00038 

INCSAVE (NS. NT) »INCSAVE (NS.NT) ♦! 

00039 

GO  TO  401 

000*0 

*10 

00  460  N3xNSTART.n«PT,N 

000*1 

call  Enter  (NS,NT,N3, T3,x3» O, ALPHAJ.»1> 

000*2 

IF  (KFlaG  .EO.  1)  GO  To  4o0 

000** 

023*sUhT ((*3-<2)**2.(v3-y2>**2) 

000*5 

ThE TA2s alpha S-ALPHA2 

SHIFT  « I LL  ShIET  THETA?  F,ET*EEn  -PI  AND  *PI 


CALL  SHIFT  (THETA2.0.0) 


THE  ALGORITHM  WILL  NOT  WORK  IF 
THET A 1 EQUALS  zero 
THETA2  EQUALS  ZERO 

ThETAI  AND  Tup T A2  HAVE  OPPOSITE  SIGNS. 

IF  ANY  OF  THESE  FAULTS  OCCUR  THF.  AlGORITm  IS  SMPPrD, 


IF  (THETA1*THETA2  «LE.  0.0)  GO  TO  460 
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IV  Ml  f 


nf:-.  •'  ■ 1 

r . ; 

1Li.il-  > 1 


’ -*■  . 


nol  fortran  (i.O) 


SumRQuT InF  SRL  <NS ) 


TmIS  IS  THE  HJAS  CALCULATION. 


00049 

00050 

00051 

00052 
00054 


THETA12=THFTA) ♦THETAS 

0ENCMs012*SIn(ThETA2) / ( D?3«S IN (1 HET A 1 ) ) -COS ( TmE T a 1 ? ) 
PM  1 = A T An ( S IN ( T n£  T A 1 ? ) /denOM) 

IF  <UtNCw  .LT,  0.0)  Pni=PHl*PI 
HS  = Pl ♦ALPHA  1- ALA (NT ) -Pw I 


ShIFT  *ILL  SHIFT  BS  BTwEEN  (ALR0T-P1)  AnU  (aLHOT.pi) 

EACH  BIAS  CALCULATION  (BS)  IS  AVEPAotO  1NTC  BSI  wITH  A 
oEIGhTInG  FACTOR  OF  «2 . 


00055 

00056 

00057 


00058 

00059 

00060 
00061 
00062 

00063 

00064 

00065 

00066 
00067 


CALL  SHIFT  (HS» ALPOT (NS) ) 

BSI*BSI ♦w2«BS 

Wl3*I*«2 


this  following  variables  are  bumped  do»n  so 
THEY  will  NOT  have  TO  BE  RECALCULATED. 


N1=N2 

N2=N3 

X2=A3 

Y2=Y3 

THETA1«THETA2 

ALPhA1=alphA2 

ALPHA2*alPhA3 

D12=U23 

w2  = *3 

CONTINUE 


COPY  /"*  ' 

rCOv  !T 

JuKril/f  Si, 


•rC'-i,  #N*.  V M 


NOL  fortran  (1.0) 


SUdHQUTINE  SPl<NS> 


00068 


00070 

00071 

00072 


00073 


NO  EaHf)HS 


« 

*E  have  NO*  fin  I Sr(£n  i>lE  LOOP  THRC'UuH  I HE  AwWAfS. 

CUnThul  "ILL  bE  HERE  A.iOuT  InCIND  I iMtS  FOR  EACH  •» 

TARGET  ANO  FOR  EACH  PASS  and.  FOR  EACH  SEnSCH.  « 

o 

00«0000#OOf«OOo«0400(HH»«000(M)«(H>»000««000*0«000«0000(M)(MH)Oa««^u 


IF  "I  EQUALS  ZERO  That  MEANS  NO  dlAb  CALCULATIONS  HA OF  • 

BEEN  DONE.  IF  This  is  SO  THEN  NO  AvtRAolNG  CAN  dE  OONE.  <• 

o 

IF  <*l  ,EQ.  0.0  .OR.  KFLAb  •£<*•  1)  OO  TO  4*5 

a 

CALCULATE  the  AVERAGE  RlAS  ANO  SET  IFlaG.  ° 

ALROT ( NS ) *RS  1/ * I 
I F L A G s 1 

0EN0M=AI2«nI2-AI8I*«2 


IF  OEiNOH  E0UALS  ZERO  ThEN  "E  HAVE  CALCULATED  OnlT  ONP  OR  * 
NO  LINES  Through  The  SENSOR.  IN  EITHER  case  a Sensor  «■ 
position  calculation  can  not  be  done  and  is  skipped,  • 


IF  (UEnom  .eg.  0.0)  GO  TO  470 

0 

THE  SENSOR  POSITION  LOCATION  IS  CALCULATED.  ANO  JF|_AG  set,  *■ 


00075 

X0  (NS)*(9ICI*AIBI-AICI«9I2) /OEnOm 

00076 

YO (NS)» (AICI»Al8I-dICI*Al2)/OENOM 

00077 

JFLAG* 1 

00078 

470 

COM  Inue 

00079 

480 

continue 

00080 

490 

CONTINUE 

00081 

RETURN 

00082 

END 

NOL  FORTRAN  DIAGNOSTIC  RESULTS  - FOR  SRL 
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cm  - 

pppl*,:™  rr 

* $ [ V( 


■'  s'-  ' •*  .■ 


NOL  FORTRAN  (1.0) 


SUBROiJ T I NE  SR(.  (NS) 


data  variables 


AI2 

ooni)  5 

00013 

000  72 

OAA  7c 

A Id  I 

onooR 

0 0015 

0 0 0 /2 

0 0 0 7 c 

A 1 C I 

OOOoS 

000  16 

000  75 

0 0 0 7 o 

ALA 

OOO  o 1 

00054 

ALROT 

00OO2 

00055 

000  70 

A S 4 V E 

00003 

AT 

00001 

Bl2 

00005 

0 00  1 A 

000  72 

0 0 0 7 c 

BlCI 

00005 

00017 

000  75 

000  76 

BT 

00001 

cs 

ooom 

CT 

00001 

IFLAG 

00OO2 

0 0 0 10 

00071 

I NCSA vt 

000O3 

ooooe 

00022 

0003b 

JFLAG 

00002 

00011 

0007  7 

KFlAG 

0000(5 

000  31 

00042 

000OR 

M 

ooooo 

oooob 

npass 

0000(5 

0 0 u 1 2 

NREP 

000(13 

00008 

00021 

NSEn 

00002 

ntrg 

000O1 

00007 

00020 

PI 

000  OA 

0CG53 

00054 

P 1 2 

0 0 0 A A 

PID2 

00004 

TA 

ooooi 

TEMP 

00001 

TSAVE 

00003 

VA 

00001 

WSAVE 

00003 

XO 

00002 

00075 

XA 

00001 

- 

Y0 

00002 

000  76 

YA 

ooooi 

ZA 

00001 

COMMON  VARIABLES 
*<>NONE*» 


PROGRAM  variables 


R ' 

a: 


alphai 

00029 

00034 

00054 

0 0 0 6 3 

\ 

ALPH A2 

00030 

00034 

00045 

000o3 

Onnfc* 

ALPHA3 

OOOAl 

00045 

00064 

A T AN 

00051 

; 

BS 

00054 

00055 

00056 

BSI 

00018 

00056 

00056 

00070 

1 

cos 

00050 

D12 

00033 

00050 

00065 

023 

00044 

00050 

00065 

ruT>5  T'.'  ;; 


nol  fortran  ti.O)  Subroutine  splinsi 


OtMOM 

00060 

00051 

00052 

000  72 

090  / i 

ENTER 

P00?O 

00030 

00041 

U 

PCO?2 

00023 

00023 

00.12  r 

0 n n 2 e 

Nl 

0 0 0 2 S 

0 0027 

0 0 0 29 

OO'JTl  — 

n2 

00027 

0002b 

00030 

ooosu 

00059 

N3 

00040 

00041 

00059 

nFIRST 

0 0 025 

00026 

NR 

0001  2 

n«pt 

00021 

00023 

00040 

ns 

OOOOO 

00006 

0 C C 0 3 

00  jc  1 

0 0 r i c 

00041 

00055 

00070 

00075 

000  7e 

NSTaRT 

00029 

00040 

NT 

00007 

0000H 

0000b 

0 0 0 2 0 

0oo2  1 

OOOTd 

00041 

00054 

PHI 

00  051 

00053 

00053 

00  06“ 

SHIFT 

000  95 

00046 

00  055 

SIN 

0 0 0 5 J 

oooso 

00051 

SORT 

000  9 ) 

00044 

T 1 

0 0 02R 

T2 

00030 

T3 

00041 

THETA)  . 

.00034 

00035 

0003o 

00047 

009“5 

THE  T A 1 2 

0 0 0 4 ‘9 

00050 

00051 

THETA2 

00044 

00046 

00047 

00049 

Ooo? 

w 1 

00  0?-) 

w2 

00090 

00056 

00057 

OUOee 

m3 

00041 

0 0 0 be 

Ml 

00019 

00057 

00057 

00060 

C 0 0 7 0 

Xl 

00029 

00033 

X2 

C0030 

00033 

O0C44 

OOOby 

X3 

00041 

00044 

00060 

Yl 

0 0 0 ?9 

00033 

Y2 

00030 

00033 

QC044 

00061 

Y3 

00041 

00044 

OOOBl 

E-43 


AD-A032  850  NAVAL  SURFACE  WEAPONS  CENTER  WHITE  OAK  LAB  SILVER  SP— ETC  F/6  17/1 
SENSOR  POSITION  LOCATOR. (U) 

SEP  75  J VALVANO 

UNCLASSIFIED  NSWC/WOL/TR  76-8  NL 

20f2 
AO 

AO32850 


NOL  FORTRAN  (1.0) 


00000 


00001 

00001 

00002 

00003 

00003 

oono* 

00005 

00006 


C 

C 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 


c 

c 

c 

c 

c 

c 


SUHHUUUnF.  EiTtfl  (NS.NT.nR.T.XT.VT.  ALPHA,*) 


JONATHAN  VALVANO 


03/1H/75  * 


ENTEK  IS  T«E  ROUTINE  That  CALCULATES  THE  LINE  From 

the  target  to  the  sensor  and  makes  The  appropriates  sums 
used 'in  the  spl  ALGORITHM. 

input*  ns  The  NUMHKU  OF  THE  SENSOR 

NT  I J TH£  'JUi-HER  OF  The  TAHGtT 

nr  1 HE  NUMBER  of  The  R.-VORI 

TSAWt  (NS. NT. NR)  THE  TUE  OF  THIS  REPORT 

ASAVd (NS.UT.NR)  The  HEARING  OF  T»t  RtPORT 

«»SAVt(NS.NT,NR>  THE  * £ t OH  T 1 N'i  FACTOR  RrtSSEP  Mr  ThE  SE*S«P 
AT.aT.CT  w**ICH  FORM  ThELINE  a T*X*UT*Y*C f *0  OF  TARGET  TRACK 
2A(Nf)  kHIC.H  IS  THE  TARGETS  ALT  1 TUOt 

TXY  -HIGH  RETURNS  THE  TARGETS  POSITION  AS  A FUNCTION  OF  T 
ALMOT  ahICR  IS  THE  SFMSORS  ANGLE  OOTaTION  BUS 


OUTPUTS  T THE  Tl«E  OF  THE  KEPOmT  < 
XT.Yl  THE  POSITION  OF  THE  TARGET  AT  tnt  TIME  OF  M£  REPORT  * 
ALPHA  THE  REPORT  HEARING  (CORRECTED  FOR  The  SrEEO  OF  SOUND)* 
w THE  COMRtNEO  WEIGHTING  FACTOR  REPORTEO  AND  CALCULATED  « 
SUMS  IN  AI?»BI2. AIHI.ATCI.HICI  FOR  SPL  ALGORITHM  • 


THESE  ARE  THE  COMMON  STATEMENTS. 


COMMON  /TROT//  ALA(3)  ,*A(3)  .YA(3)  *ZA(3)  »TA(3)  ,VA(.))  , 

1 AT (3) »dT(3) *CT (3) .TEmp.CS.nTRG 

COMMON  /S£F//  NSEN«XO(3)*YO(3)»AlROT(3) •IFLAG.JFtAO 
COMMON  /hep//  TSAVE(3.3»50) »ASAVE(3»3.50) .wSA>/E(3.3.Sn) » 
1 NREP (3.3) . INCSAVE (3.3) 

COMMON  /CONST//  PIUI02.PI2 

COMMON  /SU*-S//  AI2.RI2.AIH1. AICI. 8ICI 

COMMON  /OPTIONS//  KFLAG.M.NPASS 


B-^5 


NOE  FORTRAN  U.O) 


SUBROUTINE  FNTER  (NS.NT.Nk.T.XT.YT.MLPHA.w) 


00007 

00008 

00009 

00010 


00011 


00013 

OOOH 

00015 

00016 


00018 

00019 

00020 
00021 
00022 
00022 
00023 
0002* 
00026 


C 

C 

C 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 


c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 


c 

c 


T*TsAVE (NS.NT.NR) 
ALPHAsASAVE  (NS»NT*nR) 
WSKOAVt  (NS.NT.NP) 

CALL  TAY  (»T.YT,T.NT> 


IF  »E  APE  GOING  TO  CALCULATE  THE  BIAS  (KFLAG*0)  ANn 
IF  A HlAS  CALCULATION  was  not  BEFN  done  Then  RETURN 


IF  (1FLAG  ,EO.  0 .AND.  KFLAG  .EL.  0>  RETURN 


THE  RATIO  IS  USED  IN  Th£  ALGORITHM  10  ACCOUNT  FOR  1HF 
SPEEU  OF  SOUND  , The  TaROET  SPEED  ( V A ) MUST  HE  LESS  Than 
THE  SPEED  OF  SOUND (CS).  THIS  mLOnE  CORRECTS  Only  ThE 
TWO  UIMFNSIONAL  CASE.  TF  A SENSOR  CALCULATION  HAS  REF.-i 
OONE  BEFORE  (JFLAGsl)  THEN  THIS  ALGURITHM  CAN  CORRECT 
THE  Three  DIMENSIONAL  CASE.  IF  NO  SENSOR  POSITION 
LOCAflON  HAS  BEEN  DONE  ( jFLAi>*0)  THEN  JUST  USL  THE  ?-U. 


BETA«PI*ALA (NT)-(ALPhA-ALWOT(NS) ) 

RATIUSCS/VA (NTI 

RAYTAU*10000.0 

IF  (JFlAG  .E«.  0)  GO  TO  500 


(AP.YP)  IS  THE  POINT  ON  THE  TARGET  TRACK  AT  CPa 
THE  POINT  IS  USED  IN  THE  ALGORITHM  to  CORRECT  FOR  THE 
SPEfcU  OF  SOUND  OUE  TO  THE  ALTITUDE.  THE  RATIO  is 
RECALCULATED  TAKING  TwE  ALTITUDE  INTO  EFFECT. 

RXYTAU  is  the  Two  DIMENSIONAL  RADIAL  DISTANCE  FROM 

THE  StNSOR  TU  THE  TARGET  AT  TIME  TaU  (TIME  when  THE  SOUNu 

ORIGINATED.)  RXTTAU  IS  USEO  TO  CONSTRUCT  A W. 


0«AT (NT>*Yft(NS)-BT(NT)*XO«NS) 

D£NOM«at (NT) **2.8T (NT) *«2 

XP*“ (AT (NT» *CT ( NT ) *ST ( NT ) *0  > /OENOM 

YP* (AT (NT) *0-8T (NT) «CT  (NT) > /UENOm 

RXYTAU* (SQwT ( ( XO  <NS) -AP) **2*  I TO  InS) -YP) **2) ) / 

ABS (SIN (BETA) > 

RATIO*RaTIO*RXYTAU/SoRT(ZA (NT)**2*RXYTAU**2) 
IF  (RXYTAlJ  .GT.  5000,0)  PXYTAU*5000.0 
W«1 000. 0*w*E*P(-(HXYTMJ/1 000.0) »«2) 


B-E6 


copy 


PERMIT  fULLY  iu 


rr~.s  K3T 

r' 


fiTir. 


• » • i . \ .tiii 


wiu>« 


*"7*-  ,-L  . 


IfefitiHfrJWE 


NOL  FORTRAN  (1.0) 


SUHROUTMt  FNTER  INS. nT, NR.T, XT, YT, alpha, .y) 


00027 

00029 

00024 


00030 

00031 
03032 


00033 

00034 

00035 

00036 

00037 

00038 

00039 

00040 


c • • 

c • THETA  IS  Th£  CORRECTION  ANGLE  OLE  TO.  (HE  SPFti)  OF  S0i/no.  • 

C • C**l-Hn4  is  Th£  CORtCTFD  REPORT  FiEARiNfi. 

c * ALPHA  IS  CORRECTED  ANO  PASSED  b ACK  to  the  t)I AS  aLGOR/Ihm  • 

c • • 

c * c ALPHA  is  >jSE0  TO  CALCULATE  A«8,C  OF  THE  LINt  a*x*r*v»C«3  « 

c • THIS  line  GOES  THROUGH  THE  SENSOR  ANO  THE  TaREGT  * 

C • THE  ALGORITHM  « ILL  EVENTUALLY  (InSPL)  FINO  Thc  point  * 

C • (A0.Y0)  «HICH  MINIMUFS  THE  OISTAnCE  FROM  ThaT  POINT  • 

c • to  each  line,  a weighting  factor  is  used  in  the  least  • 

c • SQUARES  ALGORITHM,  « 

c • • 

c 

c 

500  the IA»ATAN( SIN (RETS) / (RATIO-COS (hET A) ) ) 

CALPHAs ( AljHA-AlROT (NS) ) -THETA 
AlPHA«alPH  •- TH£T a 

c 

c •••«•••***«••♦••*«••**•*•******•••*•*•••**«******•*•••*•**«***<*** 

c • • 

C * CALCULATE  A.8.C  TO  FORM  THE  LINE  a#**8*Y*C=0  * 

C * 

C 

c 

A*CUR(CALP“'A) 


C 

c 

c 

c 

c 

c 

c 


8*-SlN(CALPHA) 

C»-(A«xT*B«YT) 


maaE  The  Sums. 


A2Pb2»(A*«2*8**2)*«XYT6U**2 
AI2»AI<*.»#a**2/a2PB2 
8I2*«s  I2*«**8**2/ A2PB2 
AI8IsAI8I .«*a*8/ a2P9? 
AlCl*AICI*  «.  * A*C/  A2P82 
8ICI«bICI***fc'*C/A2PB2 
RETUHN 
ENO 


NOL  FORTRAN  UIAGNOSTIC  RESULTS  - FOR  ENTER 


NO  ERRORS 


B-47 


' 


NOU  FORTRAN  (1.0)  SUBROUTINE  FNTER  <NS«oT tNR . T * X T ,Y T t AlPHA t v | 


OATA  variables 


AI2 

00^05 

00034  . 

00034 

Alt*  l 

09005 

00036 

00036 

AICI 

00005 

00037 

00037 

ALA 

00001 

00013 

ALROT 

• 00002 

00013 

00028 

ASAVE 

Ooooa 

00006 

AT 

00001 

OOOlti 

0001"# 

00020 

0oo2  1 

612 

00005 

00035 

00035 

BlCl 

00005 

00036 

00036 

ht 

00001 

00016 

00019 

00920 

Oo«21 

cs 

00001 

00014 

CT 

00001 

00020 

00021 

I*-LAG 

00002 

00011 

INCSAvt 

00003 

JFLAG 

00002 

00016 

kflas 

00OON 

90011 

M 

OOOOfr  * 

NRASS 

00006 

NKEP 

09003 

NS£n 

00002 

NTRG 

00091 

PI 

00004 

00013 

P12 

0 0 0 A 4 

PlU2 

00004 

TA 

000O1 

TEMP 

OOOOl 

tsave 

00003 

00007 

VA 

OOOOl 

00014 

• Save 

00003 

00009 

xo 

00002 

00016 

00022 

XA 

OOOOl 

VO 

00002 

00018 

00022 

YA 

OOOOl 

2* 

OOOOl 

00023 

COMMON  VARIAUlES 

••NONE** 

PROGRAM  variables* 


A 

00030 

00032 

00033 

00034 

004  36 

A2PB2 

00033 

00034 

00035 

00036 

00037 

AMS 

00022 

ALPHA 

00000 

00008 

00013 

00026 

000?5 

atan 

00027 

B 

00031 

00032 

00033 

00035 

00036 

beta 

00013 

00022 

0002  t 

0H027 

c 

00032 

00037 

00038 

CALPMA 

0CC28 

00030 

00031 

B-^8 


NOL  FORTRAN  (1,0) 


SU8HOUTINE  ENTER  (NS,nT »nr* T * XT ,yT , alpha, *1 


cos 

OOfl’T 

00030 

0 

000  \R 

00020 

00021 

oenoh 

00019 

00020  . 

00021 

exp 

00076 

NH 

00000 

00007 

00008 

00009 

NS 

ooono 

00007 

00008 

00009 

0 o o 1 3 

00028 

NT 

00090 

00007 

00008 

OUOiiO 

Qi'O  . 0 

00019 

00019 

00020 

00020 

0 8 0 r.  0 

RATIO 

0<101* 

00023 

00023 

0002  T 

RXYTAiJ 

00015 

00022 

000Z3 

00023 

Oin** 

SIN 

00022 

00027 

00031 

SORT 

00022 

00023 

T 

00000 

00007 

00010 

THETA 

00027 

00028 

00029 

TXY 

oooio 

8 

00990 

00009 

U002O 

00026 

Oon  i*» 

XP 

00020 

00022 

XT 

00000 

00010 

00032 

Yf» 

00021 

00022 

yt 

00000 

00010 

00032 

B-^9 


copy  ; DSC  DOR  I 

PEm  FOLLY  LEGiflLE 


mXi.  — V;  , 


IOL  FORTRAN  (1.0) 


n 


! 


00000 


SUBROUTINE  SHIFT  (AnGLF.«I»S) 


c 

c • 

c • 

c • 

JONATHAN  VAltfANO 

03/1 6/T5  • 

c • 

c • 

c • 

this  routine  shifts  thf 

angle  BETwEcn 

c * 

(aIAS-Pi)  TO  (BIAS*PI) 

c • 

c • 

c * 

c 

00001 

c 

CONHON  /CONST//  PI1PI02 

,PI2 

00002 

BOO 

IF  (faUs-PT  ,LT.  ANGLE) 

GO  TO  Hio 

00004 

AHGLt*ANGLfc »PI2 

00005 

GO  To  HOO 

00006 

aio 

IF  (HIA3*pj  ,OT.  ANGLE) 

RETURN 

ooooa 

ANGLE* ANGLE ~P 12 

00009 

GO  To  dio 

00010 

£HO 

nOu  FORTRAN  DIAGNOSTIC  RESULTS  - f OH  SHIFT 


10  ERRORS 


i 


B-51 


COPY  WMUS.E  T 

FEHKST  PjUi  If  - 


NOL  FORTRAN  (1,0) 


SOMWOU  1 1 NF.  SHIFT  < ANGl.E.^lAS) 


OATa  VrtflIAdLtS 

Pi  oonoi  00002  00006 

Pi2  o«ini  0000«*  ' 00006 

P 102  00001 

COMMON  VASlAdLES 
••NONE** 

PROGRAM  VARJA8i.ES 

ANGLE  00000  00002  OOOO'*  0000*  00006 

Hi AS  00)00  00002  00006 


B-52 


NOL  FORTRAN  (1,0) 


00000 


00001 

00001 

00002 

00003 

00004 

00005 

00006 

00007 

00008 


C 

C 

C 

C 

c 

c 

c 

c 

c 

c 

c 

c 

c 


SUBROUTINE  T<Y  (XtV.T.NT) 


JONATHAN  VALVANO 


THIS  ROUT  I \£  CALCULATES  THE  TARGET  POSITION, 
THE  ROa I T I In  IS  THOUuHl  TO  BE  TRUE. 


03/18/75  * 


COMMON  /TRGT//  AL A ( 3 ) % x A ( 3 ) « Y A ( 3 ) * 2 A ( 3 ) * 
TA(3)tvA<3i*AT<3>«RT(3>.CT<3> »Tc.'*P.CS.nTRo 
COMMON  /CONST//  PI»Rin?.ej2 
ANGUta»IC2-ALA(,-lT) 

OISTsVA(NT'4(T-rA(NT) > 

X«XA (NT) ♦OIST«COSlANGLE) 

Y*YA (NT ) *OISr*SlN(ANGlt) 

RETURN 

£NO 


NOl  FORTRAN  ui AGNOSTIC  RESULTS  - FOR  T x Y 


NO  ERRORS 


NOL  FORTRAN  (1.0) 


sudHou tine  txy  <x«y.(*nt> 


DATA  VAR  1 AdLtS 


ALA 

onnn 

00003 

at 

O'^nl 

dT 

ooooi 

cs 

ooool 

cr 

Ononi 

ntrg 

00001 

pi 

00002 

PI2 

00-102 

PI02 

00002 

OOOOi 

TA 

00001 

0000* 

TEMP 

ooooi 

VA 

00O01 

0000* 

XA 

00001 

00005 

YA 

ooooi 

00006 

ZA 

ooooi 

COMMON  VAPU8(.tS 
••NONE** 

PROGRAM  VARIABLES 


angle 

00003 

00005 

OOOOe 

cos 

00005 

01ST 

0000* 

00005 

Q0006 

NT 

00000 

00003 

0000* 

S In 

00006 

T 

00000 

0000* 

X 

00000 

00005 

Y 

00000 

00006 

L FORTRAN  (].0) 


00000 


00001 

00003 

00004 

00005 
00006 

00007 

00008 
00009 
0001  1 
00012 
00013 
000U 

00015 

00016 
00017 


ERRORS 


SUBROUTINE  NO-Jmal<x> 

c 

C FORTRAN  CALL  LINE: 

c 

c call  normal (*i 

c 

c This  program  USES  the  POLAR  mETrOO  TO  GENERATE  NORMALLY  OtSTPlbUTEC 
C RANDOM  NUM8LR6  OF  ZERO  MEAN  AMO  UNIT  VARIANCE.  THE  NUMhEBS  APE 
C 6ENEP A T EO  T wO  AT  4 TIME.  SO  EVERY  OTHER  CALL  WEUUlRtS  NO  *'OPw. 

C ThE  LOCAL  INTEGER  MODE  VARI4PLe  m wIlL  normally  not  ut  one  a)  ul'AO 
C TIRE.  IF  THIS  IS  NOT  Th£  CASE  FOR  A PARTICULAR  FORTRAN  SySTF**.  The 
C USER  CAN  INITIALIZE  The  PROGRAM  VARIABLES  dY  MAKING  AN  INITIAL  CALL 

c ano  oisregauroing  the  result. 

C 

C The  SUBROUTINE  uniform  USF.O  In  THE  program  Should  GENERATE  BANCOM 
C NUMBERS  UNIFORMLY  DISTRIBUTED  BETWEEN  aERO  ano  one. 

c 

IFIM  .Eu.  1)  GO  TO  20 
M«1 

10  CALL  UNIFORM ( Y ) 

U1«2.*Y-1. 

CALL  UNIFORM  (y) 

U2»2.*Y-1. 

S»Ul*Ol*u2*u2 

IF(S  .oE.  1.)  GO  TO  10 

SaSOPTF I-2,*AlOG(S)/S)  . 

X«U1*S 
RETURN 
20  M«0 
X«U2*S 
RETURN 
EnO 

NOL  fortran  DIAGNOSTIC  results  - FOR  NORMAL 


3-57 


fjjpy  I1MM  * r 

rrn»  yit 

rthivii 2 i ,;j  , 


milH 


■ 


NOL  FORTRAN  U.O)  bjBWOUTlNF  NORMAL (A) 

OATA  VAR | AhLtS 
••nOnf.»* 

common  variables 

••none** 

PROGRAM  VARIABLES 


ALOS 

ooon 

M 

00001 

00003 

000  1* 

s 

o o o o i 

00007 

00011 

OCM  1 

SnRTF 

0001  1 

Ui 

0 ./•“>/>■» 

noud'i 

voooa 

00  1 1 -? 

U* 

0 '!  0 7 

QCOOn 

v 0 0 0 3 

0 (.•  0 1 ? 

UNIFORM 

0 o 0 0 v 

0 0 0 u o 

X 

0 0 0 0 0 

00  3 1 r. 

voois 

V 

0 0 .1 0 4 

00  JO  3 

oooos 

• ooov  r 

B-56 


. r-  *■»  r ■ .*•  r • > 


QR7Y  ' 

HL..SII  • ittll  LLC—LS. 


NOL  COMPASS  (1.0) 


UNIFORM 


CNTHr  POINT  SYMBOLS 

(JNIFOHM  ooooo 


PPOCRAM 

COMMON 

OATA 


00052 


B-6l 


UNlFOHH 


03/27/75  PAGE  2 


EMMY  ijnIFOMm 

FORTRAN  CALL  LINE’- 

CALL  UnIFORM(a) 

IF  X IS  GREATER  Tran  Or  Emuai.  Th  ZEnO  *hEn  Tnt  CALL  IS  ExEC'iTEO. 
X rs  REPLACED  .‘ITR  A kANOO*  num^ER  (inIFOWmly  F.'ISTMbUTEU  RcT»CE';  0 
AND  1.  ThE  COMMUTATION  USES  3b  BIT  INTEGER  ARITHMETIC.  AnO  CONvfRTS 
TO  FlOAIING  POINT.  THE  AlGOMIIhm  Is  ThE  lINEAk  LUNORijENT  ] ai. 
method  mITh  a mOoOLUS  OF  2**35,  a “ULTIPlIER  <>F  6**1S«  ANp  AN 

increment  of  726i0b70cs.  these  parameters  have  uEtN  extensively 
TESTFO.  and  YIELD  a maximum  LENGTH  sequence  with  good  SPECTRAL 
PROPERTIES. 

IF  x IS  LESS  Than  ZERO  *hEn  T«E  CALL  I*  EXECUTED,  -X  IS 
CO-WEPTEO  TO  a 3-3  HIT  FIXED  POINT  FuaCTION.  ac.U  IhF  MOST  SIGNIFICANT 
35  MTS  ARE  USEU  TO  INITIALIZE  ThE  RANDOM  NUMrEH  mENERATOR.  IF  -X  IS 
GREATER  Than  Or  £JUaL  10  1 OR  LESS  Than  2«*-J«,  Trf  SEQUENCE  MI.L 
ST^RT  *'  1 Th  ZERO.  THE  STARTING  VALUE  IS  CONVERTED  10  FLOATING  POINT 
ANO  RETURNED  In  X.  SO  That  x is  ALWAYS  A FRACTION  peTaEEn  0 AMJ  1 On 
RETURN. 


Enter,  GET  X,  unO  branch  to  Initialization  IF  nEGMIvE. 


77777 

0 

UNIFORM 

ujp 

#*' 

EnTRy  point 

POOOOO 

1 

LD I 

UNIFORM, ] 

parameter  address  to  «i 

OOOO'T 

1 

LOAQ.I 

0*1 

X To  AO 

P0002* 

3 

AZJ.ET 

1*1  T 

Initialize  if  x lt  zero 

IF  A 

GE  ZERO  On 

CALL,  GENERATE  A NE*  RANDOM  NUMBER. 

P 0 0 0 A ? 

0 

ldaq 

Y 

NE»Y«  I a*OLOY*2*C)  MOo2**3Xi 

PCPOAA 

0 

hUAO 

A 

0000'! 

3 

EAJ 

07777 

2 

ANA 

7777B 

POPOAA 

C 

ADAQ 

C 2 

07777 

2 

ANA 

7777B 

P000.2 

0 

CONT 

ST  AQ 

Y 

SAVE  Y FOR  NEXT  TIME 

CONVERT  the  36 

BIT  NUMBER 

IN  AQ  TO  A FLOATING  PUIM  FRACTION. 

02013 

2 

SCAO 

20138,2 

SCALE  AQ.Pl ASEO  ExPOnENI  TO  62 

P00022 

0 

AZJ.EQ 

RETURN 

ZERO  IS  A SPECIAL  CASt 

02000 

2 

ISG 

2000B.2 

TEST  FOR  NON-NEGATIVE  EaponEnT 

77775 

2 

INI 

-1,2 

ADJUST  BIAS  IF  NEGATIVE 

00031 

0 

SHAQ 

25 

MERGE  FRACTION  and  EXPONENT 

• 0000 

? 

A I A 

2 

0001A 

6 

SHAO 

12 

ao  is  no*  a floating  point  fraction 

STORE 

AO  IN  X, 

AnD  return 

to  callin';  program. 

00000 

i 

RETURN 

S T AO. I 

0,1 

store  aq  tn  x 

B-62 


copy  Ay/ILAELE  TO  pT(!  r;,r"  f'OT 

PMT  FiaiY  LEGIBLE  FFX!  ! iGil 


UNIFORM 


01/27/7 R PAGE 


00001  l UJP  1*1  REIuwn  Tn  PARAMETER  aUUmFSS  » J 

IF  * lT  ZERO  ON  CA|.tt  CONVERT  -*  To  F I X£l)  POINT  Am)  US£  tT  To 
initialize  f*E  random  MjwrtR  generator. 


77777 

0 INIT 

XOA«S 

77777b 

NEGATE  Aq 

77777 

1 

trOU  • S 

77777b 

ono** 

0 

Sma-J 

30 

biasfo  exponent  to  rx 

00  00*’ 

2 

TAI 

2 

017  7 7 

2 

ANl 

3777B. 2 

0001-4 

9 

SMAQ 

IE 

FRACTION  TO  AO 

07777 

2 

ANA 

7777b 

02001 

2 

ISG 

2001S.2 

SKIP  IF  E*PONtNT  Gt  I 

01  73«- 

2 

ISG 

I73SB.2 

SKIP  IF  EiRONEM  GF  -3* 

ROOOSi 

-) 

10A0 

ZERO 

FORCE  7ERO  IE  txPON£NT  OiiT  OF  POUNDS 

31777 

2 

ISG 

1 777b. 2 

SKIP  IF  EXPONENT  N0N-NCOATT Vfc 

7 fi  0 C 0 

T 

SiHAQ 

-17770.2 

EAMUNENT  is  SmIFT  COUNT.  JF  negative 

7777a 

I 

* 

/.no,s 

7/77t>3 

CL7.-P  LSF  TO  RETAIN  Js  rUS 

R'JOOl? 

i) 

UJP 

CRN! 

USE  AU  FOP  NE»  V IN  mail  LOOP 

constants  ano  vapibles 


100 

Y 

OCT 

0*0 

>00 

*32 

A 

OCT 

3*32.7724*619 

TrtlA 

is 

5**15 

Us 

>M 

C2 

OCT 

15*1,  -.5*27232 

this 

is 

2*726106  7 Ob? 

232 

100 

ZERO 

OCT 

0.0 

100 

ENO 

. 

Ni.'MeER  OF  LINES  «ITh  DIAGNOSTICS  0 


pnnY 


'Mi  If? 


r m 


pr-rO 
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Copies 

12 


Defense  Documentation  Center 
Cameron  Station 
Alexandria,  VA  22314 

MITRE  Corporation 
1820  Dolley  Madison  Blvd 
McLean,  VA  22101 
Attn:  C.  L.  Woodbridge 

ADTC/AFATL 
Eglin  AFB,  FL  32542 
Attn:  J.  G.  Constantine  (DLJM) 

Army  Mobility  Equipment  Research  & Development  Command 
Fort  Belvoir,  VA  22060 
Attn:  Library 

Army  Engineer  Waterways  Experiment  Station 
P.0.  Box  631 
Vicksburg,  MS  39180 
Attn:  Dr.  Lundien 

Army  Electronics  Command  AMSEL-CT-I 
Fort  Monmouth,  NJ  07703 
Attn:  A.  Zarin 

Naval  Sea  Systems  Command 
Washington,  D.  C.  20360 
Attn:  SEA-03B 


TO  AIO  IN  UPDATING  THE  DISTRIBUTION  LIST 
FOR  NAVAL  SURFACE  WEAPONS  CENTER,  WHITE 
OAK  LABORATORY  TECHNICAL  REPORTS  PLEASE 
COMPLETE  THE  FORM  BELOW: 


TO  ALL  HOLDERS  OF  NSWC/WOL/T&  36-8 
by  Joseph  Reid  Cods  VA-22 
DO  NOT  RETURN  THIS  FORM  IF  ALL  INFORMATION  IS  CURRENT 


A.  FACILITY  NAMC  ANO  AOORESS 


| — | REMOVE  THIS  FACILITY  FROM  THE  DISTRIBUTION  LIST  FOR  TECHNICAL  REPORTS  ON  THIS  SUBJECT . 


